
2月25日
Dependencies: mbed SpeedController2_25 ros_lib_kinetic
can/can.cpp
- Committer:
- yuki0701
- Date:
- 2020-02-25
- Revision:
- 5:fe91d31db27e
- Parent:
- 4:46c10d34af27
File content as of revision 5:fe91d31db27e:
//#include "mbed.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 // //double mt_out1=0.0,mt_out2=0.0; // //int t1_r=0, T1=0; //動作番号(受け取った値、送信する値(int型)) // //void can_readsend() //{ // CANMessage msg; // // // if(can1.read(msg)) { // //printf(" CAN success\n\r"); // if(msg.id == 4) { // mt_out1 = 1/(double)200*(short)((msg.data[0]<<8) | msg.data[1]); // mt_out2 = 1/(double)200*(short)((msg.data[2]<<8) | msg.data[3]); // //mt_out1 = 1/(double)50*(short)((msg.data[4]<<8) | msg.data[5]); // //mt_out2 = 1/(double)50*(short)((msg.data[6]<<8) | msg.data[7]); // //debug_printf("usw_data1 = %f\n\r",usw_data1); // printf("mt_out1 = %f,mt_out2 = %f\n\r",mt_out1,mt_out2); // } // // if(msg.id == 7){ //// mt_out2 = 1/(double)50*(short)((msg.data[0]<<8) | msg.data[1]); //// printf("id = 5 mt_out2 = %f, data[0] = %d, data[1] = %d\n\r",mt_out2,msg.data[0],msg.data[1]); //// } // // } else { // canread_led = 0; // printf("fale\n\r"); // } // // // // can_ashileddata[1] = T1; //動作番号(id節約のため、can_ashileddata[]と一緒に送る) // //// can_ashileddata2[0] = m1 >> 8; //// can_ashileddata2[1] = m1 &255; //// //// can_ashileddata3[0] = m1 >> 8; //// can_ashileddata3[1] = m1 &255; //// //// can_ashileddata4[0] = m1 >> 8; //// can_ashileddata4[1] = m1 &255; //// //// can_ashileddata5[0] = m1 >> 8; //// can_ashileddata5[1] = m1 &255; //// //// if(can1.write(CANMessage(4,can_ashileddata2,2))) { //IDを4にして送信 //// cansend_led = 1; //// } else { //// cansend_led = 0; //// } //// //// if(can1.write(CANMessage(4,can_ashileddata3,2))) { //IDを4にして送信 //// cansend_led = 1; //// } else { //// cansend_led = 0; //// } //// //// if(can1.write(CANMessage(4,can_ashileddata4,2))) { //IDを4にして送信 //// cansend_led = 1; //// } else { //// cansend_led = 0; //// } //// //// if(can1.write(CANMessage(4,can_ashileddata5,2))) { //IDを4にして送信 //// cansend_led = 1; //// } else { //// cansend_led = 0; //// } // // /*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); //遅かったら早める //}