Added useful things from demot, merged compass and rudder into one "turning" thing, TODO: complete main loop, differential power and other motor stuff