25 lines
838 B
C
25 lines
838 B
C
#pragma once
|
|
|
|
const float ACCEL_LIMIT = 5.0; // cm/s/s
|
|
const float VEL_LIMIT = 15.0; // cm/s
|
|
const float BACKLASH_RIGHT = 0.0; // degrees
|
|
const float BACKLASH_LEFT = 0.0; // degrees
|
|
const float WHEEL_DIAMETER = 6.37; // cm
|
|
const float WHEEL_TO_WHEEL = 0.0; // cm
|
|
|
|
// centimeters per second to rpm
|
|
const float CMS_RPM = 60.0 / (PI*WHEEL_DIAMETER);
|
|
|
|
// degrees to centimeters
|
|
const float DEG_CM = (PI*WHEEL_DIAMETER) / 360.0;
|
|
|
|
const float FORWARD_DISTANCE = 30.0; // cm
|
|
const float TURN_AMOUNT = 180.0; // degrees
|
|
const float RETURN_DISTANCE = 100.0; // cm
|
|
|
|
const float FF_ACCEL = 100.0; // motor acceleration feedforward
|
|
const float FF_VEL = 0.9; // motor velocity feedforward
|
|
const float FF_STAT = 100.0; // motor static friction
|
|
const float KP = 3.7; // proportional
|
|
const float KI = 0.3; // integral
|
|
const float KD = 0.0; // derivative
|