2017_hongo_bteam_jushinkun_gamma
Dependencies: gamma_controller_ mbed serial_2017_
main.cpp@0:c12ce6882f7a, 2017-08-17 (annotated)
- Committer:
- Komazawa_sun
- Date:
- Thu Aug 17 06:39:02 2017 +0000
- Revision:
- 0:c12ce6882f7a
2017_hongo_bteam_jushinkun_gamma
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Komazawa_sun | 0:c12ce6882f7a | 1 | #include "mbed.h" |
Komazawa_sun | 0:c12ce6882f7a | 2 | #include "gamma_ctrl.h" |
Komazawa_sun | 0:c12ce6882f7a | 3 | #define I2C_SDA dp5 |
Komazawa_sun | 0:c12ce6882f7a | 4 | #define I2C_SCL dp27 |
Komazawa_sun | 0:c12ce6882f7a | 5 | |
Komazawa_sun | 0:c12ce6882f7a | 6 | DigitalOut read_success_led(LED1); |
Komazawa_sun | 0:c12ce6882f7a | 7 | DigitalOut read_error_led(LED2); |
Komazawa_sun | 0:c12ce6882f7a | 8 | I2CSlave transmit(I2C_SDA,I2C_SCL); |
Komazawa_sun | 0:c12ce6882f7a | 9 | gamma_ctrl twe(115200); |
Komazawa_sun | 0:c12ce6882f7a | 10 | void status_led(); |
Komazawa_sun | 0:c12ce6882f7a | 11 | void i2c_send(); |
Komazawa_sun | 0:c12ce6882f7a | 12 | |
Komazawa_sun | 0:c12ce6882f7a | 13 | int main() |
Komazawa_sun | 0:c12ce6882f7a | 14 | { |
Komazawa_sun | 0:c12ce6882f7a | 15 | transmit.address(GAMMA_ADDRESS); |
Komazawa_sun | 0:c12ce6882f7a | 16 | while(1) |
Komazawa_sun | 0:c12ce6882f7a | 17 | { |
Komazawa_sun | 0:c12ce6882f7a | 18 | twe.get_data(); |
Komazawa_sun | 0:c12ce6882f7a | 19 | status_led(); |
Komazawa_sun | 0:c12ce6882f7a | 20 | i2c_send(); |
Komazawa_sun | 0:c12ce6882f7a | 21 | /*printf("status:%d",twe.error_status); |
Komazawa_sun | 0:c12ce6882f7a | 22 | printf(",rx:%d,ry:%d,r,%d%d%d%d",twe.pack.data.rx,twe.pack.data.ry, |
Komazawa_sun | 0:c12ce6882f7a | 23 | twe.pack.data.r_sw1,twe.pack.data.r_sw2, |
Komazawa_sun | 0:c12ce6882f7a | 24 | twe.pack.data.r_sw3,twe.pack.data.r_sw4); |
Komazawa_sun | 0:c12ce6882f7a | 25 | printf("\r\n");*/ |
Komazawa_sun | 0:c12ce6882f7a | 26 | //wait(0.1); //wait変えないで |
Komazawa_sun | 0:c12ce6882f7a | 27 | wait(0.03); |
Komazawa_sun | 0:c12ce6882f7a | 28 | } |
Komazawa_sun | 0:c12ce6882f7a | 29 | } |
Komazawa_sun | 0:c12ce6882f7a | 30 | |
Komazawa_sun | 0:c12ce6882f7a | 31 | void status_led() |
Komazawa_sun | 0:c12ce6882f7a | 32 | { |
Komazawa_sun | 0:c12ce6882f7a | 33 | if(twe.error_status == 0) |
Komazawa_sun | 0:c12ce6882f7a | 34 | { |
Komazawa_sun | 0:c12ce6882f7a | 35 | read_error_led = 0; |
Komazawa_sun | 0:c12ce6882f7a | 36 | read_success_led = 1; |
Komazawa_sun | 0:c12ce6882f7a | 37 | } |
Komazawa_sun | 0:c12ce6882f7a | 38 | else |
Komazawa_sun | 0:c12ce6882f7a | 39 | { |
Komazawa_sun | 0:c12ce6882f7a | 40 | read_error_led = 1; |
Komazawa_sun | 0:c12ce6882f7a | 41 | read_success_led = 0; |
Komazawa_sun | 0:c12ce6882f7a | 42 | } |
Komazawa_sun | 0:c12ce6882f7a | 43 | } |
Komazawa_sun | 0:c12ce6882f7a | 44 | |
Komazawa_sun | 0:c12ce6882f7a | 45 | void i2c_send() |
Komazawa_sun | 0:c12ce6882f7a | 46 | { |
Komazawa_sun | 0:c12ce6882f7a | 47 | if(transmit.receive() == I2CSlave::ReadAddressed){ |
Komazawa_sun | 0:c12ce6882f7a | 48 | //read_error_led = 1; |
Komazawa_sun | 0:c12ce6882f7a | 49 | transmit.write(twe.pack.all_data,GAMMA_DATA_SIZE); |
Komazawa_sun | 0:c12ce6882f7a | 50 | }//else |
Komazawa_sun | 0:c12ce6882f7a | 51 | //read_error_led = 0; |
Komazawa_sun | 0:c12ce6882f7a | 52 | } |