Tests Commit 2

New robot test and old one improved. Unit tests started but still very in
progress.