Added some recommended test comments / functions
Robot state now inherited from loc, wrote custom equals operator.
Wrote path state.