mirror of
https://github.com/arduino/Arduino.git
synced 2024-12-12 23:08:52 +01:00
367a0ae9f4
Changes include (according to Paul Stoffregen): "1: Hardware abstraction layer to support Arduino Mega, Teensy and Sanguino. 2: Extended analog message, to facilitate using PWM and Servo above pin 15. 3: Capability queries (alpha), to allow automatic discovery of any board's features."
43 lines
818 B
Plaintext
43 lines
818 B
Plaintext
/* This firmware supports as many servos as possible using the Servo library
|
|
* included in Arduino 0017
|
|
*
|
|
* TODO add message to configure minPulse/maxPulse/degrees
|
|
*
|
|
* This example code is in the public domain.
|
|
*/
|
|
|
|
#include <Servo.h>
|
|
#include <Firmata.h>
|
|
|
|
Servo servos[MAX_SERVOS];
|
|
|
|
void analogWriteCallback(byte pin, int value)
|
|
{
|
|
if (IS_PIN_SERVO(pin)) {
|
|
servos[PIN_TO_SERVO(pin)].write(value);
|
|
}
|
|
}
|
|
|
|
void setup()
|
|
{
|
|
byte pin;
|
|
|
|
Firmata.setFirmwareVersion(0, 2);
|
|
Firmata.attach(ANALOG_MESSAGE, analogWriteCallback);
|
|
|
|
for (pin=0; pin < TOTAL_PINS; pin++) {
|
|
if (IS_PIN_SERVO(pin)) {
|
|
servos[PIN_TO_SERVO(pin)].attach(PIN_TO_DIGITAL(pin));
|
|
}
|
|
}
|
|
|
|
Firmata.begin(57600);
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
while(Firmata.available())
|
|
Firmata.processInput();
|
|
}
|
|
|