Resets motor encoder before setting motor power levels in drive function

Also removes an unused constant