implemented raibert controller.  Also committing final changes from proj 5