void Grip(int gripTicks, int gripSpeed)
{
servo_setramp(16, 32);
servo_angle(16, gripTicks);
//dprint(term, "Using Gripper");
//pause(gripSpeed);
gripState = -1;
}
int main() // main function
{
servo_angle(16, 0); // P16 servo to 0 degrees
pause(500); // Allow 1/2 second to get there
servo_setramp(16, 7); // Change by up to 7/10 degree/20 ms
servo_angle(16, 1800); // P16 servo to 180 degrees
pause(6000); // Allow 6 seconds to get there
// (with ramping in effect)
servo_stop(); // Stop servo process
}
