hsu han-lin / Mbed 2 deprecated DXL_SDK_Porting_Test

Still Test

Dependencies:   DXL_SDK_For_F446RE RobotControl_7Axis Matrix mbed

main.cpp

Committer:
stanley1228
Date:
2017-02-07
Revision:
0:1780ffc33286
Child:
2:fb9508744bc4

File content as of revision 0:1780ffc33286:

#include "mbed.h"
#include "dynamixel.h"

#define ADDRESS_LED 0x19


DigitalOut myled(LED1);
Serial pc(SERIAL_TX, SERIAL_RX);


int main()
{
   int rt =0;
   
    pc.printf("start\n",rt);
  
    rt=dxl_initialize( 1, 1);
    pc.printf("dxl_initialize rt=%d\n",rt);

    myled = 0; // LED is ON
    
    /**************************
    *** Check communication ***
    **************************/
    
    pc.printf("before=%d\n",rt);
    dxl_write_byte(3,ADDRESS_LED,0);
    //dxl_ping(3);
    
    pc.printf("after=%d\n",rt);
    while(1)
    {
        dxl_write_byte(3,ADDRESS_LED,1);
        //myled = 1; // LED is ON
        wait(2);
        dxl_write_byte(3,ADDRESS_LED,0);
        //myled = 0; // LED is ON
        wait(2);
    }
}