imu class squeleton added
stabilize.py organized.

squetelon structed. It seems that the dynamical model uses
the angles and not the rates when deriving the voltages so
no need to worry about getting the rates. The readings from
the IMU (after having passed through the DMP) are assumed to
be (pitch, roll, yaw) angles.