Page 693 - 2

float z;
}Coordinate;

// 단위 도 미리미터,
typedef struct Vector {
float pos;
float x;
float y;
}Vector;

Vector object_p1[5];
Vector object_p2[5];

Vector A;
Vector B;

// 현재상태
Vector state;
// m/s, deg/s
Vector speed;

void slide(Vector);
void focusing(int);
float angle_x(Coordinate, Vector);
float angle_y(Coordinate, Vector);
void save_object_at_onetime(float, int);
void save_object(Vector, Vector, int);
void free_move();
void to_A();
void to_B();
void setA();
void setB();
void motor_control();
void init();

void init()
{
speed.pos = 0;
speed.x = 0;
speed.y = 0;

state.pos = 0;
state.x = 0;
state.y = 0;

- 693 -