File tree Expand file tree Collapse file tree 2 files changed +4
-4
lines changed
Expand file tree Collapse file tree 2 files changed +4
-4
lines changed Original file line number Diff line number Diff line change @@ -695,7 +695,7 @@ void Arduino_AlvikCarrier::updateKinematics(){
695695 if (kinematics_movement==MOVEMENT_ROTATE){
696696 rotate_pid->update (kinematics->getTheta ());
697697 drive (0 , round (rotate_pid->getControlOutput ()/10.0 )*10 );
698- if (abs (rotate_pid->getError ())<ROTATE_THREASHOLD ){
698+ if (abs (rotate_pid->getError ())<ROTATE_THRESHOLD ){
699699 kinematics_achieved=true ;
700700 disableKinematicsMovement ();
701701 drive (0 ,0 );
@@ -704,7 +704,7 @@ void Arduino_AlvikCarrier::updateKinematics(){
704704 if (kinematics_movement==MOVEMENT_MOVE){
705705 move_pid->update ((kinematics->getTravel ()-previous_travel)*move_direction);
706706 drive (round (move_pid->getControlOutput ()/10.0 )*10 , 0 );
707- if (abs (move_pid->getError ())<MOVE_THREADSHOLD ){
707+ if (abs (move_pid->getError ())<MOVE_THRESHOLD ){
708708 kinematics_achieved=true ;
709709 disableKinematicsMovement ();
710710 drive (0 ,0 );
Original file line number Diff line number Diff line change @@ -46,14 +46,14 @@ const float MOTOR_RATIO = MOTOR_CPR*MOTOR_GEAR_RATIO;
4646#define ROTATE_KD_DEFAULT 0.001
4747#define ROTATE_CONTROL_PERIOD 0.02
4848#define ROTATE_MAX_SPEED 45.0
49- #define ROTATE_THREASHOLD 1
49+ #define ROTATE_THRESHOLD 1
5050
5151#define MOVE_KP_DEFAULT 5.0
5252#define MOVE_KI_DEFAULT 0.0
5353#define MOVE_KD_DEFAULT 0.001
5454#define MOVE_CONTROL_PERIOD 0.02
5555#define MOVE_MAX_SPEED 45.0
56- #define MOVE_THREADSHOLD 3
56+ #define MOVE_THRESHOLD 3
5757
5858#define MOVEMENT_DISABLED 0
5959#define MOVEMENT_ROTATE 1
You can’t perform that action at this time.
0 commit comments