Add simulator tests

[emmaworley]

Let's figure out how to use gazebo and run automated tests with it to make sure we don't introduce regressions in things like our auto routines.