2月25日
Dependencies: uw_28015 mbed ros_lib_kinetic move4wheel2 EC CruizCore_R6093U CruizCore_R1370P
can/can.cpp
- Committer:
- yuki0701
- Date:
- 2020-02-25
- Revision:
- 0:44f9a43e4ab2
File content as of revision 0:44f9a43e4ab2:
#include "mbed.h" #include "PathFollowing.h" #include "movement.h" #include "manual.h" #include "can.h" CAN can1(p30,p29); Ticker can_ticker; //can用ticker DigitalOut cansend_led(LED1); //cansend -> on DigitalOut canread_led(LED2); //canread -> on int t1_r=0, T1=0; //動作番号(受け取った値、送信する値(int型)) int k = 0; void can_readsend() { CANMessage msg; if(can1.read(msg)) { //printf(" CAN success\n\r"); if(msg.id == 2) { t1_r = msg.data[0]; //printf("main T1 = %d t1_r = %d\n\r",T1,t1_r); } } else { canread_led = 0; //printf("fale\n\r"); } /* if(k > 100){ printf("T1 in can_read = %d\n\r",T1); k = 0; } k++;*/ can_num[0] = T1; //動作番号(id節約のため、can_ashileddata[]と一緒に送る) //can_num[0] = 1; can_ashileddata2[0] = m1 >> 8; can_ashileddata2[1] = m1 &255; can_ashileddata2[2] = m2 >> 8; can_ashileddata2[3] = m2 &255; can_ashileddata2[4] = m3 >> 8; can_ashileddata2[5] = m3 &255; can_ashileddata2[6] = m4 >> 8; can_ashileddata2[7] = m4 &255; if(can1.write(CANMessage(1,can_num,1))) { cansend_led = 1; } if(can1.write(CANMessage(4,can_ashileddata2,8))) { //IDを4にして送信 //printf("success : %d \n\r",m1); cansend_led = 1; } if(t1_r > T1) { T1 = t1_r; } } void can_start() { while(1) { CANMessage msg; // debug_printf("wait\n\r"); printf("wait\n\r"); wait(0.1); if(can1.read(msg)) { break; } } } void UserLoopSetting_can() { can1.frequency(1000000); can_ticker.attach(&can_readsend,0.01); //遅かったら早める }