/* arm.c */ #define POT_ARM_TOP 13 #define POT_ARM_90 100.0 int set_arm_pos(float angle) { set_servo_pos(SERVO_ARM, angle); } float get_arm_pot_angle() { return ((float)(analog(PORT_POT_ARM)-POT_ARM_TOP))*PI_2/POT_ARM_90; } float get_arm_servo_angle() { return get_servo_pos(SERVO_ARM); }