Partially implemented different robot types

Signed-off-by: Lewis Storey <iamlewisstorey@yahoo.com>