1/24 操舵 中央 can receivedata++;
Dependencies: mbed
Fork of Control_Main_CANver1 by
Diff: main.cpp
- Revision:
- 0:efd2956da873
- Child:
- 1:21010e775c79
diff -r 000000000000 -r efd2956da873 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Sat Jan 23 17:37:58 2016 +0000 @@ -0,0 +1,55 @@ +//中央can program + +#include "mbed.h" +#define WAIT_LOOP_TIME 0.1 +#define YOKUTAN_DATAS_NUM 5 +#define IMPUT_DATAS_NUM 2 +#define SEND_DATAS_CAN_ID 100 + +CAN can(p9,p10); +Serial toKeikiSerial(p28,p27); +Serial pc(USBTX,USBRX); +DigitalIn eruron(p7); +DigitalIn drug(p8); + +signed char yokutanDatas[YOKUTAN_DATAS_NUM]; +char inputDatas[IMPUT_DATAS_NUM]; + +void InputAndSentControlValues(){ + inputDatas[0] = eruron; + inputDatas[1] = drug; + for(int i = 0; i < IMPUT_DATAS_NUM; i++){ + if(can.write(CANMessage(SEND_DATAS_CAN_ID, inputDatas, IMPUT_DATAS_NUM))){ + pc.printf("send successed!\n\r"); + } + } +} + +void SendDarasToKeiki(){ + for(int i = 0; i < YOKUTAN_DATAS_NUM; i++){ + toKeikiSerial.putc(yokutanDatas[i]); + } +} + +void toString(){ + for(int i = 0; i < YOKUTAN_DATAS_NUM; i++){ + pc.printf("%i:",yokutanDatas[i]); + } + pc.printf("\n\r"); +} + +void init(){ +} + +int main(){ + init(); + while(1){ + InputAndSentControlValues(); + wait_us(10); + if(can.read(recmsg)){ + receiveDatas(); + } + toString(); + wait(WAIT_LOOP_TIME); + } +} \ No newline at end of file