Serial1.write(value & 0x7F); // Analog LS 7 bits

  Serial1.write(value >> 7);   // Analog MS 7 bits

} 

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

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

//   a servo signal.

void firmata_servoWrite(int pin, int value)

{ 

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

  Serial1.write(value & 0x7F);

  Serial1.write(value >> 7);

} 

/////////////////////////////////

// Low level Firmata functions //

/////////////////////////////////

// Firmata helper functions you probably won't need to call in

// your sketch. If this was a class, these'd be private functi

ons.

// checkSerial()

// Interrupt­recurring function. Checks for available serial d

ata

// and processes any serial messages that come in.

void checkSerial()

{ 

while (Serial1.available())

  { 

//Serial.write(Serial1.read());

firmata_processInput((unsigned char) Serial1.read());

  } 

if (blinkFlag)

  { 

firmata_digitalWrite(13, HIGH); // Tell Arduino to write 1

3 HIGH

    blinkFlag = false;

  } 

else

  { 

firmata_digitalWrite(13, LOW); // Tell Arduino to write 1

3 HIGH

    blinkFlag = true;

  } 

} 

// firmata_processInput([inputData])

// Handles all Firmata messages ­ everything from version chec

ks

// to analog and digital readings.

void firmata_processInput(unsigned char inputData)

{ 

int command;

if (parsingSysex) // If we're parsing a system message

  { 

if (inputData == END_SYSEX)

    { // Received end of system message, process it

      parsingSysex = false;

firmata_processSysexMessage();

    } 

else

    { // In the system message, add to it

      storedInputData[sysexBytesRead] = inputData;

      sysexBytesRead++;

Page 11 of 14