Main Program
Dependencies: mbed AQM1602 HMC6352 PID
setting/main.h@19:342da3a5a474, 2016-01-21 (annotated)
- Committer:
- lilac0112_1
- Date:
- Thu Jan 21 07:11:08 2016 +0000
- Revision:
- 19:342da3a5a474
- Parent:
- 18:97eba56f82e4
- Child:
- 21:d69a8f3c76e1
Main part was reconstructed.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
lilac0112_1 | 14:6f214ea5722e | 1 | #ifndef _MAIN_H_ |
lilac0112_1 | 14:6f214ea5722e | 2 | #define _MAIN_H_ |
lilac0112_1 | 14:6f214ea5722e | 3 | |
lilac0112_1 | 14:6f214ea5722e | 4 | #include "def.h" |
lilac0112_1 | 14:6f214ea5722e | 5 | |
lilac0112_1 | 16:6900f47fa0b5 | 6 | //pc(Computer) |
lilac0112_1 | 16:6900f47fa0b5 | 7 | RawSerial pc(monitor_tx, monitor_rx); |
lilac0112_1 | 16:6900f47fa0b5 | 8 | //led(main) |
lilac0112_1 | 16:6900f47fa0b5 | 9 | DigitalOut LED[4]={led1, led2, led3, led4}; |
lilac0112_1 | 16:6900f47fa0b5 | 10 | //line(bottom) |
lilac0112_1 | 18:97eba56f82e4 | 11 | BusOut LineSignalHolder(lineInA, lineInB, lineInC); |
lilac0112_1 | 18:97eba56f82e4 | 12 | BusIn RawLineSignal(lineA1, lineB1, lineC1); |
lilac0112_1 | 18:97eba56f82e4 | 13 | BusIn HeldLineSignal(lineA2, lineB2, lineC2); |
lilac0112_1 | 16:6900f47fa0b5 | 14 | //ballcheck(bottom) |
lilac0112_1 | 16:6900f47fa0b5 | 15 | DigitalIn BallChecker(ballcheck); |
lilac0112_1 | 16:6900f47fa0b5 | 16 | //debug_switch(debug_board) |
lilac0112_1 | 17:61edad76efd7 | 17 | DigitalIn Sw[4] = {selectsw1, selectsw2, debugsw1, debugsw2}; |
lilac0112_1 | 16:6900f47fa0b5 | 18 | //motor(main) |
lilac0112_1 | 16:6900f47fa0b5 | 19 | Serial motor(motor_tx, motor_rx); |
lilac0112_1 | 16:6900f47fa0b5 | 20 | //spi(main) |
lilac0112_1 | 16:6900f47fa0b5 | 21 | SPI spi(SPI_mosi, SPI_miso, SPI_slck); |
lilac0112_1 | 16:6900f47fa0b5 | 22 | DigitalOut spi_ss[4]={SPI_ss_sd, SPI_ss_sonic, SPI_ss_color, SPI_ss_ir}; |
lilac0112_1 | 16:6900f47fa0b5 | 23 | //bluetooth(debug_board) |
lilac0112_1 | 16:6900f47fa0b5 | 24 | RawSerial RN42(blue_rxd, blue_txd); |
lilac0112_1 | 16:6900f47fa0b5 | 25 | DigitalOut RN42_Reset(blue_reset); |
lilac0112_1 | 16:6900f47fa0b5 | 26 | //lcd(debug_board) |
lilac0112_1 | 16:6900f47fa0b5 | 27 | AQM1602 Lcd(lcd_sda, lcd_scl); |
lilac0112_1 | 16:6900f47fa0b5 | 28 | //gyro(debug_board) |
lilac0112_1 | 16:6900f47fa0b5 | 29 | MPU6050 mpu(sens_sda, sens_scl); // sda, scl pin |
lilac0112_1 | 16:6900f47fa0b5 | 30 | InterruptIn INT0(sens_interrupt); // INT0 pin |
lilac0112_1 | 16:6900f47fa0b5 | 31 | //mouse(bottom) |
lilac0112_1 | 16:6900f47fa0b5 | 32 | adns_9800 mouse_sensor(mouse_mosi, mouse_miso, mouse_slck, mouse_ss); |
lilac0112_1 | 16:6900f47fa0b5 | 33 | //solenoid(bottom) |
lilac0112_1 | 16:6900f47fa0b5 | 34 | DigitalOut kicker(solenoid); |
lilac0112_1 | 16:6900f47fa0b5 | 35 | |
lilac0112_1 | 16:6900f47fa0b5 | 36 | //Serial for motors |
lilac0112_1 | 16:6900f47fa0b5 | 37 | int speed[4]={0}; |
lilac0112_1 | 16:6900f47fa0b5 | 38 | string StringFIN; |
lilac0112_1 | 16:6900f47fa0b5 | 39 | //PID |
lilac0112_1 | 16:6900f47fa0b5 | 40 | PID pid(P_GAIN,I_GAIN,D_GAIN, RATE); |
lilac0112_1 | 16:6900f47fa0b5 | 41 | Ticker pidupdate; |
lilac0112_1 | 16:6900f47fa0b5 | 42 | //for Serial |
lilac0112_1 | 14:6f214ea5722e | 43 | volatile uint8_t INdata[DATA_NUM]={0}, EXdata[DATA_NUM]={0}; |
lilac0112_1 | 16:6900f47fa0b5 | 44 | //for DataSet |
lilac0112_1 | 14:6f214ea5722e | 45 | Record data; |
lilac0112_1 | 19:342da3a5a474 | 46 | //for transition |
lilac0112_1 | 19:342da3a5a474 | 47 | Ticker Sw_ticker; |
lilac0112_1 | 19:342da3a5a474 | 48 | Timeout button; |
lilac0112_1 | 19:342da3a5a474 | 49 | bool state[4]={0,0,0,0}; |
lilac0112_1 | 19:342da3a5a474 | 50 | uint8_t statesum=0, last_statesum=0; |
lilac0112_1 | 16:6900f47fa0b5 | 51 | // for Time |
lilac0112_1 | 14:6f214ea5722e | 52 | Timer t; |
lilac0112_1 | 14:6f214ea5722e | 53 | Ticker Duty[DUTY_NUM]; |
lilac0112_1 | 14:6f214ea5722e | 54 | Timeout Stp; |
lilac0112_1 | 14:6f214ea5722e | 55 | double dutycycle[DUTY_NUM] ={//[s] |
lilac0112_1 | 14:6f214ea5722e | 56 | 0.2 |
lilac0112_1 | 14:6f214ea5722e | 57 | }; |
lilac0112_1 | 14:6f214ea5722e | 58 | |
lilac0112_1 | 14:6f214ea5722e | 59 | #endif /*_MAIN_H_*/ |