Update mw.c

Fixed Horizon mode. Reworked Yaw I calculation.