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 }