recalibrate some motor functions and add orientation logic
Merge pull request #10 from jimmyhlee94/refactor-take-2

recalibrate some motor functions and add orientation logic