Rhino Reimburse / Mbed 2 deprecated XL320_Test

Dependencies:   mbed

Committer:
mfajaradityo
Date:
Thu Feb 25 04:19:15 2016 +0000
Revision:
2:0ec2dce7c5f8
Parent:
0:2071f8e463dd
Child:
3:89bed7a6d852
Important Get/Set Functions work correctly in 115200 BaudRate

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mfajaradityo 2:0ec2dce7c5f8 1 //#include "mbed.h"
mfajaradityo 0:2071f8e463dd 2 #include "XL320_MFA.h"
mfajaradityo 0:2071f8e463dd 3
mfajaradityo 0:2071f8e463dd 4 XL320 servoTest(115200, p9, p10, p8);
mfajaradityo 0:2071f8e463dd 5
mfajaradityo 0:2071f8e463dd 6 uint8_t value = 100;
mfajaradityo 0:2071f8e463dd 7
mfajaradityo 0:2071f8e463dd 8 int main()
mfajaradityo 0:2071f8e463dd 9 {
mfajaradityo 0:2071f8e463dd 10 while(1)
mfajaradityo 0:2071f8e463dd 11 {
mfajaradityo 0:2071f8e463dd 12 wait(1);
mfajaradityo 0:2071f8e463dd 13
mfajaradityo 0:2071f8e463dd 14 servoTest.TurnOnLED(1, 1);
mfajaradityo 0:2071f8e463dd 15 servoTest.TurnOnLED(1, 2);
mfajaradityo 0:2071f8e463dd 16 servoTest.TurnOnLED(1, 3);
mfajaradityo 0:2071f8e463dd 17 servoTest.TurnOnLED(1, 4);
mfajaradityo 0:2071f8e463dd 18 servoTest.TurnOnLED(1, 5);
mfajaradityo 0:2071f8e463dd 19 servoTest.TurnOnLED(1, 6);
mfajaradityo 0:2071f8e463dd 20 servoTest.TurnOnLED(1, 7);
mfajaradityo 0:2071f8e463dd 21 servoTest.TurnOnLED(1, 8); // should return error message
mfajaradityo 0:2071f8e463dd 22 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 23
mfajaradityo 2:0ec2dce7c5f8 24 value = servoTest.GetID(1);
mfajaradityo 0:2071f8e463dd 25 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 26
mfajaradityo 2:0ec2dce7c5f8 27 value = servoTest.GetBaudRate(1);
mfajaradityo 0:2071f8e463dd 28 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 29
mfajaradityo 2:0ec2dce7c5f8 30 value = servoTest.GetRetDelTime(1);
mfajaradityo 0:2071f8e463dd 31 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 32
mfajaradityo 2:0ec2dce7c5f8 33 value = servoTest.GetCWAngLim(1);
mfajaradityo 0:2071f8e463dd 34 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 35
mfajaradityo 2:0ec2dce7c5f8 36 value = servoTest.GetCCWAngLim(1);
mfajaradityo 0:2071f8e463dd 37 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 38
mfajaradityo 2:0ec2dce7c5f8 39 value = servoTest.GetContMode(1);
mfajaradityo 0:2071f8e463dd 40 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 41
mfajaradityo 0:2071f8e463dd 42 servoTest.SetGoalVel(1, 1000);
mfajaradityo 0:2071f8e463dd 43 servoTest.translateLastRPacket();
mfajaradityo 2:0ec2dce7c5f8 44 value = servoTest.GetGoalVel(1);
mfajaradityo 0:2071f8e463dd 45 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 46
mfajaradityo 0:2071f8e463dd 47 servoTest.SetGoalPos(1, 0);
mfajaradityo 0:2071f8e463dd 48 servoTest.translateLastRPacket();
mfajaradityo 2:0ec2dce7c5f8 49 value = servoTest.GetGoalPos(1);
mfajaradityo 0:2071f8e463dd 50 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 51
mfajaradityo 0:2071f8e463dd 52 wait(1);
mfajaradityo 0:2071f8e463dd 53 servoTest.SetGoalVel(1, 200);
mfajaradityo 0:2071f8e463dd 54 servoTest.translateLastRPacket();
mfajaradityo 2:0ec2dce7c5f8 55 value = servoTest.GetGoalVel(1);
mfajaradityo 0:2071f8e463dd 56 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 57
mfajaradityo 0:2071f8e463dd 58 servoTest.SetGoalPos(1, 1000);
mfajaradityo 0:2071f8e463dd 59 servoTest.translateLastRPacket();
mfajaradityo 2:0ec2dce7c5f8 60 value = servoTest.GetGoalPos(1);
mfajaradityo 0:2071f8e463dd 61 servoTest.translateLastRPacket();
mfajaradityo 0:2071f8e463dd 62 wait(1);
mfajaradityo 0:2071f8e463dd 63 }
mfajaradityo 0:2071f8e463dd 64 }