Add more firmata test coverage