At this stage we have got working 4 motors, and magnetometer