Updated class diagram.
Added robot models.
Added simple controller and test.