Add dPad drive (#19), add constrain to speed/rot