Kazutaka "Zak" Sawa / Mbed 2 deprecated mbed_XBus_MotionTest

Dependencies:   XBusServo mbed

Files at this revision

API Documentation at this revision

Comitter:
sawa
Date:
Wed Nov 05 08:47:14 2014 +0000
Parent:
1:4b239aea14f4
Commit message:
add error check at init

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/main.cpp	Wed Nov 05 07:36:23 2014 +0000
+++ b/main.cpp	Wed Nov 05 08:47:14 2014 +0000
@@ -136,8 +136,13 @@
     }
 
     // initialize XBus Servos
-    for (counter = 0; counter < kMaxServoNum; counter++)
-        gXBus.addServo(servoChannel[counter], kXbusServoNeutral);
+    for (counter = 0; counter < kMaxServoNum; counter++) {
+        result = gXBus.addServo(servoChannel[counter], kXbusServoNeutral);
+        if (result != kXBusError_NoError) {
+            gXBus.stop();
+            return result;
+        }
+    }
 
     return kXBusError_NoError;
 }