[Megan]

This is some Arduino C code I wrote to find the stop value of some modified servos, for anyone interested in Arduino's I figured I would share this here, feel free to ask questions or critique my code if you know what you're talking about.

Code:

/****************************** * * * Servo Calibration * * VERSION: 0.01 * * * ******************************/ // adds the Servo library to the sketch! #include <Servo.h> // assigns the servos names to be used accordingly Servo leftServo; Servo righServo; // Setting some variables, I like to assign them numbers regardless int servoSpeed = 0; int servoSet = 0; int servoChoice = 0; int leftServoStop = 0; int righServoStop = 0; // Function time! void leftServoCal(){ // A Potentially endless for loop because I like to do it this rudimentary way for(int x = 0; x < 999;){ Serial.println("How fast do you want the servo to run at?"); while (!Serial.available()){;} // Waits for a user to answer the question. servoSpeed = Serial.parseInt(); Serial.print("Servo speed set at "); Serial.println(servoSpeed); leftServo.write(servoSpeed); // Sets the servo speed based on the users input & tells the user just for clarification // Checks to see if the servo has stopped, this gives a delay until the user is ready to continue, I included instructions because it is impossible for the user to know how to work it without knowledge. Serial.println(); Serial.println("Has the servo stopped?"); Serial.println("0 = No | 1 = Yes"); while (!Serial.available()){;} servoSet = Serial.parseInt(); if(servoSet == 0){ // No Serial.println("No!"); Serial.println(); } else if (servoSet == 1){ // Yes Serial.println("Yes!"); Serial.println(); x = 999; // If the servo has stopped then yeah, it'll end the for loop. } else{ Serial.println("Unacceptable value, try again!"); // error handling } } // Just tells the user what the servo numbers are set to. Serial.println("Servo calibration complete!"); Serial.print("Left servo stop speed is "); Serial.print(servoSpeed); Serial.println(); Serial.println(); leftServoStop = servoSpeed; servoCal(); // Takes them to the servo calibration UI again. } // I'm not going to comment on this function as it is identical to the above except for a few names related to which servo is operating. void righServoCal(){ for(int x = 0; x < 999;){ Serial.println("How fast do you want the servo to run at?"); while (!Serial.available()){;} servoSpeed = Serial.parseInt(); Serial.print("Servo speed set at "); Serial.println(servoSpeed); righServo.write(servoSpeed); Serial.println(); Serial.println("Has the servo stopped?"); Serial.println("0 = No | 1 = Yes"); while (!Serial.available()){;} servoSet = Serial.parseInt(); if(servoSet == 0){ // No Serial.println("No!"); Serial.println(); } else if (servoSet == 1){ // Yes Serial.println("Yes!"); Serial.println(); x = 999; } else{ Serial.println("Unacceptable value, try again!"); } } Serial.println("Servo calibration complete!"); Serial.print("Left servo stop speed is "); Serial.print(servoSpeed); Serial.println(); Serial.println(); righServoStop = servoSpeed; servoCal(); } // A simple function to stop both servos when they are finally calibrated. void servoStop(){ Serial.println("Both Servo Stop values have been calibrated!"); leftServo.write(leftServoStop); righServo.write(righServoStop); } // Servo calibration UI void servoCal(){ Serial.println("Which servo do you wish to calibrate?"); Serial.println("0 = left | 1 = Right | 2 = Both complete"); Serial.println(); while (!Serial.available()){;} servoChoice = Serial.parseInt(); if(servoChoice == 0){ leftServoCal(); } else if(servoChoice == 1){ righServoCal(); } else if(servoChoice == 2){ servoStop(); } else{ Serial.println("Unacceptable value, try again!"); // Error handling servoCal(); } } void setup() { Serial.begin(9600); // Connects to the Serial Console leftServo.attach(6); // Attaches to the left servo aka number 6 righServo.attach(5); // Attaches to the right servo aka number 5 servoCal(); // and it runs the servo calibration UI } void loop() { }