@@ -57,13 +57,13 @@ void uArmClass::alert(byte times, byte runTime, byte stopTime)
5757void uArmClass::writeAngle (double servo_rot_angle, double servo_left_angle, double servo_right_angle, double servo_hand_rot_angle)
5858{
5959 attachAll ();
60-
60+
6161 if (servo_left_angle < 10 ) servo_left_angle = 10 ;
6262 if (servo_left_angle > 120 ) servo_left_angle = 120 ;
6363 if (servo_right_angle < 10 ) servo_right_angle = 10 ;
6464 if (servo_right_angle > 110 ) servo_right_angle = 110 ;
6565
66- if (servo_left_angle + servo_right_angle > 160 )
66+ if (servo_left_angle + servo_right_angle > 160 )
6767 {
6868 servo_right_angle = 160 - servo_left_angle;
6969 return ;
@@ -72,7 +72,7 @@ void uArmClass::writeAngle(double servo_rot_angle, double servo_left_angle, doub
7272 writeServoAngle (SERVO_LEFT_NUM ,servo_left_angle,true );
7373 writeServoAngle (SERVO_RIGHT_NUM ,servo_right_angle,true );
7474 writeServoAngle (SERVO_HAND_ROT_NUM ,servo_hand_rot_angle,true );
75-
75+
7676
7777 // refresh logical servo angle cache
7878 cur_rot = servo_rot_angle;
@@ -387,8 +387,9 @@ void uArmClass::writeStretch(double armStretch, double armHeight){
387387 }
388388 double offsetL = 0 ;
389389 double offsetR = 0 ;
390- EEPROM .get (OFFSET_STRETCH_START_ADDRESS + 1 * sizeof (offsetL), offsetL);
391- EEPROM .get (OFFSET_STRETCH_START_ADDRESS + 2 * sizeof (offsetR), offsetR);
390+
391+ EEPROM .get (OFFSET_STRETCH_START_ADDRESS , offsetL);
392+ EEPROM .get (OFFSET_STRETCH_START_ADDRESS + 4 , offsetR);
392393 armStretch = constrain (armStretch, ARM_STRETCH_MIN , ARM_STRETCH_MAX ) + 68 ;
393394 armHeight = constrain (armHeight, ARM_HEIGHT_MIN , ARM_HEIGHT_MAX );
394395 double xx = armStretch*armStretch + armHeight*armHeight;
0 commit comments