Added basic robot tests. Fixed a few issues with unit tests