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(){
695
695
if (kinematics_movement==MOVEMENT_ROTATE){
696
696
rotate_pid->update (kinematics->getTheta ());
697
697
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 ){
699
699
kinematics_achieved=true ;
700
700
disableKinematicsMovement ();
701
701
drive (0 ,0 );
@@ -704,7 +704,7 @@ void Arduino_AlvikCarrier::updateKinematics(){
704
704
if (kinematics_movement==MOVEMENT_MOVE){
705
705
move_pid->update ((kinematics->getTravel ()-previous_travel)*move_direction);
706
706
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 ){
708
708
kinematics_achieved=true ;
709
709
disableKinematicsMovement ();
710
710
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;
46
46
#define ROTATE_KD_DEFAULT 0.001
47
47
#define ROTATE_CONTROL_PERIOD 0.02
48
48
#define ROTATE_MAX_SPEED 45.0
49
- #define ROTATE_THREASHOLD 1
49
+ #define ROTATE_THRESHOLD 1
50
50
51
51
#define MOVE_KP_DEFAULT 5.0
52
52
#define MOVE_KI_DEFAULT 0.0
53
53
#define MOVE_KD_DEFAULT 0.001
54
54
#define MOVE_CONTROL_PERIOD 0.02
55
55
#define MOVE_MAX_SPEED 45.0
56
- #define MOVE_THREADSHOLD 3
56
+ #define MOVE_THRESHOLD 3
57
57
58
58
#define MOVEMENT_DISABLED 0
59
59
#define MOVEMENT_ROTATE 1
You can’t perform that action at this time.
0 commit comments