Update mw.c

Make Althold hightchange more compfy, better has midstick passed detection, some changes for autostart. Can flight test in the evening, it's just a merge with my other codebase.