Clean up miscellaneous code
Major code cleanup

Add TODOS in comments, remove extraneous code, remove gyro business.