Fixed #242; Added unit tests

* Added a unit testing framework for the arduino
* Fixed an issue where commands that were sent through the internal command structure would have to get sent twice if they were the first internal command sent.
* Found and fixed an issue where the argument count was not being populated correctly. (Yippy unit tests!)