Major Update

added some basic main code, finished gyro, although untested