春ロボ1班(元F3RC4班+) / Mbed 2 deprecated harurobo_mbed_undercarriage_sub_2_6

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   Harurobo_CAN_1_19 mbed Maxon_setting_1_11 move4wheel2 EC PathFollowing_2_6 CruizCore_R1370P

main.cpp

Committer:
yuki0701
Date:
2018-12-22
Revision:
1:0c9f53f5c9d0
Parent:
0:f0f40dddc0c4
Child:
3:112c4ddf324d

File content as of revision 1:0c9f53f5c9d0:

#include "mbed.h"
#include "EC.h"
#include "R1370P.h"
#include "move4wheel.h"
#include "PathFollowing.h"
#include "Maxon_setting.h"

CAN can1(p30,p29,1000000);
DigitalOut led(LED1);
Ticker ticker;

void can_read(){//CAN通信受信
    
    CANMessage msg;
    
    if(can1.read(msg)){
      
      if(msg.id == 1){
        led = 1;
       usw_data1 =  0.01 * (short)((msg.data[0]<<8) | msg.data[1]);
     printf("usw_data1 = %d:%d,%lf\n\r",msg.data[0],msg.data[1],usw_data1);
      }else if(msg.id == 2){
        //led = 1;
      //  usw_data2 = 0.01 * (short)((msg.data[0]<<8) | msg.data[1]);
        //printf("usw_data2 = %d:%d,%d\n\r",msg.data[0],msg.data[1],usw_data2);
      }else if(msg.id == 3){
        //led = 1;
        //usw_data3 = 0.01 * (short)((msg.data[0]<<8) | msg.data[1]);
        //printf("usw_data3 = %d:%d,%d\n\r",msg.data[0],msg.data[1],usw_data3);
      }else if(msg.id == 4){
        //led = 1;
        //usw_data4 = 0.01 * (short)((msg.data[0]<<8) | msg.data[1]);
        //printf("usw_data4 = %d:%d,%d\n\r",msg.data[0],msg.data[1],usw_data4);
      }
          
    }
}


//////////////////////////////////////////////////////////////以下main文/////////////////////////////////////////////////////////////////
int main()
{   
    UserLoopSetting();
    //UserLoopSetting2();
    //Debug_Control()
    

    //purecurve2(5,1,1,0,0,-500,-500,9,1500,5,0.1,10,0.1,600,0);
    //gogo_straight(1,1,0,0,500,0,2000,2000,5,0.1,10,0.1,600,0);
    
    ticker.attach(&can_read,0.01);
    
    while(1);
      //printf("%f\n\r",usw_data1);
    

    //MotorControl(0,0,0,0);
}