Broken, read
fixing...
Reworked firmata parsing