The dynamics checks result in the robot driving in a drunken manner, and have been commented out in #15 . TODO: fix the dynamics checks.
