Commit 857c7c05 authored by Thomas Pryor's avatar Thomas Pryor
Browse files

Create handControl.ino

parent b4277c3e
void writeToHandMotors()
{
for(int i = 0; i < 3; i++) {
Serial.print("Hand: ");
Serial.print(i);
Serial.println(hand[i]);
if(hand[i] == 0 || hand[i] == 2) {
if(hand[i] == 0 && handPos[i] < 180) {
handPos[i] += 5;
}
else if(handPos[i] > 0) {
handPos[i] -= 5;
}
handMotor[i].write(handPos[i]);
}
}
}
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment