int main(int argc, char **argv)
{
setupUUGear();
setShowLogs(0);
/* replace the device id with yours (listed by lsuu) */
UUGearDevice dev = attachUUGearDevice ("UUGear-Arduino-9886-9947");
if (dev.fd != -1)
{
/* attach servo on pin 4 */
attachServo(&dev, 4);
/* move servo to 30 degrees */
writeServo(&dev, 4, 30);
/* give some time to move */
sleep(1);
/* move servo to 90 degrees */
writeServo(&dev, 4, 90);
/* give some time to move */
sleep(1);
/* detach servo */
detachServo(&dev, 4);
detachUUGearDevice (&dev);
}
else
{
printf("Can not open UUGear device.\n");
}
cleanupUUGear();
return 0;
}
void setupMotorServo()
{
// init moror
motorServoR.attach(SERVO_PIN_B,544,2400); // 10
motorServoR.write(SPEED_ZERO);
delay(3800);
// initialize the LED pin as an output:
pinMode(LED,OUTPUT);
// init servo and set it to midle
wheelServoR.attach(SERVO_PIN_A,920,2070); // 9
writeServo(0);
}
/** \brief Writes a value to one of the servo headers to control a servo or electronic speed dontroller
\param[in] servo Servo connection number (1-6)
\param[in] value Value from -500 to 500 representing the full range of the servo or ESC
\param[out] boolean Returns 1 if servo successfulyy written, or 0 if servo is not initialized
**/
int RCadapter::writeServo(char servo, int value)
{
value = map(value, -512, 512, MIN_PULSE_WIDTH, MAX_PULSE_WIDTH);
switch (servo) {
case 1: return writeServo(servo_1, value); break;
case 2: return writeServo(servo_2, value); break;
case 3: return writeServo(servo_3, value); break;
case 4: return writeServo(servo_4, value); break;
case 5: return writeServo(servo_5, value); break;
case 6: return writeServo(servo_6, value); break;
}
}
