APT Motor control w/ Input

Sans working. I mean it works. But needs error check