Rhino Reimburse / Mbed 2 deprecated XL320_Test

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:   mbed

main.cpp

Committer:
mfajaradityo
Date:
2016-02-25
Revision:
2:0ec2dce7c5f8
Parent:
0:2071f8e463dd
Child:
3:89bed7a6d852

File content as of revision 2:0ec2dce7c5f8:

//#include "mbed.h"
#include "XL320_MFA.h"

XL320 servoTest(115200, p9, p10, p8);

uint8_t value = 100;

int main()
{
    while(1)
    {        
        wait(1);
                
        servoTest.TurnOnLED(1, 1);
        servoTest.TurnOnLED(1, 2);
        servoTest.TurnOnLED(1, 3);
        servoTest.TurnOnLED(1, 4);
        servoTest.TurnOnLED(1, 5);
        servoTest.TurnOnLED(1, 6);
        servoTest.TurnOnLED(1, 7); 
        servoTest.TurnOnLED(1, 8); // should return error message
        servoTest.translateLastRPacket();
        
        value = servoTest.GetID(1);
        servoTest.translateLastRPacket();        
        
        value = servoTest.GetBaudRate(1);
        servoTest.translateLastRPacket();
        
        value = servoTest.GetRetDelTime(1);
        servoTest.translateLastRPacket();
        
        value = servoTest.GetCWAngLim(1);
        servoTest.translateLastRPacket();
        
        value = servoTest.GetCCWAngLim(1);
        servoTest.translateLastRPacket();
        
        value = servoTest.GetContMode(1);
        servoTest.translateLastRPacket();
        
        servoTest.SetGoalVel(1, 1000);
        servoTest.translateLastRPacket();
        value = servoTest.GetGoalVel(1);
        servoTest.translateLastRPacket();
        
        servoTest.SetGoalPos(1, 0);
        servoTest.translateLastRPacket();
        value = servoTest.GetGoalPos(1);
        servoTest.translateLastRPacket();
        
        wait(1);
        servoTest.SetGoalVel(1, 200);
        servoTest.translateLastRPacket();
        value = servoTest.GetGoalVel(1);
        servoTest.translateLastRPacket();
        
        servoTest.SetGoalPos(1, 1000);
        servoTest.translateLastRPacket();
        value = servoTest.GetGoalPos(1);
        servoTest.translateLastRPacket();
        wait(1);            
    }    
}