Fix minor bugs
Fill in skeleton fns for drive encoder functions
Working on #29