Refactors and Tests for Robot class

:roller_coaster: