1919 * SOFTWARE.
2020 */
2121
22- #include < HiTechnicServo.h>
23- #include < HiTechnicDcMotorController.h>
24- #include < HiTechnicController.h>
25- #include < HiTechnicMotor.h>
26- #include < HiTechnicServoController.h>
27- #include < Wire.h>
22+ #include " HiTechnicController.h"
23+ #include " HiTechnicDcMotorController.h"
24+ #include " HiTechnicMotor.h"
25+ #include " HiTechnicServoController.h"
26+ #include " HiTechnicServo.h"
27+ #include " Wire.h"
28+
29+ using DaisyChainPosition = HiTechnicController::DaisyChainPosition;
30+ using MotorPort = HiTechnicDcMotorController::MotorPort;
31+ using RunMode = HiTechnicDcMotorController::RunMode;
32+ using ZeroPowerBehavior = HiTechnicDcMotorController::ZeroPowerBehavior;
33+ using Direction = HiTechnicMotor::Direction;
34+ using ServoPort = HiTechnicServoController::ServoPort;
2835
2936#define PRESCALAR 4
3037#define TWI_FREQ 37390L
3138
39+ /*
40+ * ================================================================
41+ * Begin user code
42+ * ================================================================
43+ */
44+
3245boolean somethingFound = false ;
3346
3447void setup ()
@@ -45,17 +58,17 @@ void loop()
4558 Serial.println (" Probing I2C bus for HiTechnic controllers..." );
4659 somethingFound = false ;
4760
48- tryMotorController (HiTechnicController:: DaisyChainPosition::FIRST);
49- tryMotorController (HiTechnicController:: DaisyChainPosition::SECOND);
50- tryMotorController (HiTechnicController:: DaisyChainPosition::THIRD);
51- tryMotorController (HiTechnicController:: DaisyChainPosition::FOURTH);
52- tryMotorController (HiTechnicController:: DaisyChainPosition::NONE);
53-
54- tryServoController (HiTechnicController:: DaisyChainPosition::FIRST);
55- tryServoController (HiTechnicController:: DaisyChainPosition::SECOND);
56- tryServoController (HiTechnicController:: DaisyChainPosition::THIRD);
57- tryServoController (HiTechnicController:: DaisyChainPosition::FOURTH);
58- tryServoController (HiTechnicController:: DaisyChainPosition::NONE);
61+ tryMotorController (DaisyChainPosition::FIRST);
62+ tryMotorController (DaisyChainPosition::SECOND);
63+ tryMotorController (DaisyChainPosition::THIRD);
64+ tryMotorController (DaisyChainPosition::FOURTH);
65+ tryMotorController (DaisyChainPosition::NONE);
66+
67+ tryServoController (DaisyChainPosition::FIRST);
68+ tryServoController (DaisyChainPosition::SECOND);
69+ tryServoController (DaisyChainPosition::THIRD);
70+ tryServoController (DaisyChainPosition::FOURTH);
71+ tryServoController (DaisyChainPosition::NONE);
5972
6073 if (!somethingFound)
6174 {
@@ -67,7 +80,7 @@ void loop()
6780 delay (5000 );
6881}
6982
70- void tryMotorController (HiTechnicController:: DaisyChainPosition pos)
83+ void tryMotorController (DaisyChainPosition pos)
7184{
7285 HiTechnicDcMotorController controller (pos);
7386
@@ -80,7 +93,7 @@ void tryMotorController(HiTechnicController::DaisyChainPosition pos)
8093 {
8194 Serial.print (" --> Motor controller at daisy chain address " );
8295
83- if (pos == HiTechnicController:: DaisyChainPosition::NONE)
96+ if (pos == DaisyChainPosition::NONE)
8497 {
8598 Serial.println (" NONE" );
8699 }
@@ -93,7 +106,7 @@ void tryMotorController(HiTechnicController::DaisyChainPosition pos)
93106 }
94107}
95108
96- void tryServoController (HiTechnicController:: DaisyChainPosition pos)
109+ void tryServoController (DaisyChainPosition pos)
97110{
98111 HiTechnicServoController controller (pos);
99112
@@ -106,7 +119,7 @@ void tryServoController(HiTechnicController::DaisyChainPosition pos)
106119 {
107120 Serial.print (" --> Servo controller at daisy chain address " );
108121
109- if (pos == HiTechnicController:: DaisyChainPosition::NONE)
122+ if (pos == DaisyChainPosition::NONE)
110123 {
111124 Serial.println (" NONE" );
112125 }
0 commit comments