Finished RoboticStaff 2.0

More tests tomorrow, and then it's ready to the release!