// ­ digitalInputData[] is updated in firmata_processInput()

//   as serial messages come in.

int firmata_digitalRead(int pin)

{ 

return (digitalInputData[pin >> 3] >> (pin & 0x07)) & 0x01;

} 

// firmata_analogRead([pin])

// ­ Returns the latest analog value we've read on the request

ed

//   pin.

// ­ analogInputData[] is updated in firmata_processInput()

//   as serial messages come in.

int firmata_analogRead(int pin)

{ 

return analogInputData[pin];

} 

// firmata_pinMode([pin], [mode])

// ­ Set an Arduino pin to input, output, analog in, PWM, serv

o,

//   shift register, or i2c.

// ­ [pin] ­ can be any Arduino pin 0­13, A0­A7

// ­ [mode] ­ should be one of these defined values:

//          ­ MODE_INPUT  ­ Digital input

//          ­ MODE_OUTPUT ­ Digital output

//          ­ MODE_ANALOG ­ Analog input

//          ­ MODE_PWM    ­ Analog output

//          ­ MODE_SERVO  ­ Servo output

//          ­ MODE_SHIFT  ­ Shift register output

void firmata_pinMode(int pin, int mode)

{ 

  Serial1.write(SET_PIN_MODE);

  Serial1.write(pin);

  Serial1.write(mode);

} 

// firmata_digitalWrite([pin], [value])

// ­ Set an Arduino digital pin to HIGH or LOW

// ­ [pin] ­ Any digital pin 0­18

// ­ [value] ­ LOW or HIGH

void firmata_digitalWrite(int pin, int value)

{ 

int port = (pin >> 3) & 0x0F;

int data;

if (value)

    data |= (1 << (pin & 0x07));

else

    data &= ~(1 << (pin & 0x07));

  Serial1.write(DIGITAL_MESSAGE | port); // Digital data

  Serial1.write(data & 0x7F); // Digital pins 0­6 bitmask

  Serial1.write(data >> 7);   // Digital pin 7 bitmask

} 

// firmata_analogWrite([pin], [value])

// ­ Set an Arduino pin ­ CONFIGURED AS PWM (!) ­ to an

//   analog output value.

// ­ [pin] ­ Any analog output capable pin (3, 5, 6, 9, 10, 11

// ­ [value] ­ 0­255

void firmata_analogWrite(int pin, int value)

{ 

  Serial1.write(ANALOG_MESSAGE | (pin& 0x0F)); // Analog pin

Page 10 of 14