Update MecanumDrive.java

Fixed problem where prev values are not set.