Cleaned up imu.py more commented out stuff, so that code can run without being connected to processor. still needto fix imu angle calcs. fixed a simple unecessary self. in registers.py