Added support for mecanum drives