Fix some of the known values and include error check

[ku-ya]

• Get mass of the quad
• Use IMU for attitude control
• Check auto synch for times (ROS master time used for all?)
• Motor cutoff: find the origin of problem