void servo_init();
void servo_loop();
void servo_deg(int servoid, int deg);
void move();
int getpos(int pin);