#include "main.h"
//Tanslate angle into Capture Compare Register value 
#define ANGLETOCCR(angle) (2000 * (angle) / 180 + 500)

extern int16_t Servo_Speed,Servo_goal,Servo_position;

void Servo_SetAngle(int goal);
int Servo_toward(void);