fixed upd bugs, added all sensor threads, added imu functionality