Reworked Mecha movement and flight code