Large refactor of simple_motion.py

Increase accuracy of motion, remove motion timeout, add steering timeout
Add simple service for testing