diff --git a/RLS_V1.0/.DS_Store b/RLS_V1.0/.DS_Store index 1d5c59b..a56568c 100644 Binary files a/RLS_V1.0/.DS_Store and b/RLS_V1.0/.DS_Store differ diff --git a/RLS_V1.0/R2Home_SOFTWARE_V1.01/.DS_Store b/RLS_V1.0/R2Home_SOFTWARE_V1.01/.DS_Store new file mode 100644 index 0000000..9526170 Binary files /dev/null and b/RLS_V1.0/R2Home_SOFTWARE_V1.01/.DS_Store differ diff --git a/RLS_V1.0/R2Home_SOFTWARE_V1.01/R2Home_SERVO.step/R2Home_SERVO.step.ino b/RLS_V1.0/R2Home_SOFTWARE_V1.01/R2Home_SERVO/R2Home_SERVO.ino similarity index 92% rename from RLS_V1.0/R2Home_SOFTWARE_V1.01/R2Home_SERVO.step/R2Home_SERVO.step.ino rename to RLS_V1.0/R2Home_SOFTWARE_V1.01/R2Home_SERVO/R2Home_SERVO.ino index 659d7ea..4374a98 100644 --- a/RLS_V1.0/R2Home_SOFTWARE_V1.01/R2Home_SERVO.step/R2Home_SERVO.step.ino +++ b/RLS_V1.0/R2Home_SOFTWARE_V1.01/R2Home_SERVO/R2Home_SERVO.ino @@ -49,6 +49,7 @@ if ((millis()-tread)>=(1000/a)) { tread = millis(); parallax_steer = inputCmd.getPulse(); + parallax_steer = constrain(parallax_steer, 1050, 1950); parallax_steer = map(parallax_steer,1000, 2000, 1050, 1950); Serial.print(parallax_steer); Serial.print(","); Serial.print(feedback_value); Serial.print(","); Serial.print(error); Serial.print(","); Serial.println(PIDsum); @@ -72,6 +73,8 @@ void updatecmd(int a) { raterror = (error-lasterror); PIDsum = (Kp*error)+(Kd*raterror); cmd = 1500 + PIDsum; + if (cmd >1500) {cmd = cmd+20;} + if (cmd <1500) {cmd = cmd-20;} constrain(cmd, 1000, 2000);