added spnav to IK without driverobot interaction test file, began re-write of driveRobot to not use radians. files are everywhere and need a cleanup