Added better manual movement code (untested because i don't have access to the hardware right now)