robocup
Dependencies: HMC6352 PID mbed
main.h
- Committer:
- akudohune
- Date:
- 2013-03-08
- Revision:
- 0:13ab960fc61f
File content as of revision 0:13ab960fc61f:
#define RATE 0.004173 #define Long 1.0 #define ENTER 0 #define EXIT 1 #define MOT_NUM 4 #define MOTDRIVER_WAIT 300 //ms #define BAUD_RATE 115200 #define ON 1 #define OFF 0 DigitalOut led1(LED1); DigitalOut led2(LED2); DigitalOut led3(LED3); HMC6352 compass(p9, p10); Serial driver(p28, p27); // tx, rx Serial pc(USBTX, USBRX); // tx, rx DigitalIn StartButton(p21); DigitalIn CalibEnterButton(p22); DigitalIn CalibExitButton(p23); PID pid(1.5, 0.0, 0.000002, RATE); Ticker pidUpdata; Ticker IR; Ticker ultrasonic; Timer timer1; Timer timer2; Timer timer_ir; /* 赤外線用タイマー */ int speed[MOT_NUM] = {0}; static float lastData = 0.0; static float inputPID = 180.0; static float standard; static float compassPID = 0.0; extern string StringFIN; extern int direction; extern int Distance; extern int IR_found; extern double ball_sankaku[16][2]; extern void Ultrasonic(void); extern void IR_Position(void); extern void PidUpdata(void); extern void array(int,int,int,int);