Adding acceptance test to prevent robot from falling

Any movement that would result in the robot falling from the table must be prevented
However further valid movement commands must still be allowed.
Generalised the positions in movement steps

So that we can now test a variety of positions