You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
40 lines
708 B
Plaintext
40 lines
708 B
Plaintext
/* This firmware supports as many servos as possible using the Servo" library
|
|
* included in Arduino 0012
|
|
*
|
|
* TODO add message to configure minPulse/maxPulse/degrees
|
|
*
|
|
* This example code is in the public domain.
|
|
*/
|
|
|
|
#include <Firmata.h>
|
|
#include <Servo.h>
|
|
|
|
Servo servo9;
|
|
Servo servo10;
|
|
|
|
void analogWriteCallback(byte pin, int value)
|
|
{
|
|
if(pin == 9)
|
|
servo9.write(value);
|
|
if(pin == 10)
|
|
servo10.write(value);
|
|
}
|
|
|
|
void setup()
|
|
{
|
|
Firmata.setFirmwareVersion(0, 2);
|
|
Firmata.attach(ANALOG_MESSAGE, analogWriteCallback);
|
|
|
|
servo9.attach(9);
|
|
servo10.attach(10);
|
|
|
|
Firmata.begin(57600);
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
while(Firmata.available())
|
|
Firmata.processInput();
|
|
}
|
|
|