Updated setVelocity method to use SE2.
Updated WalkCommand to use SE2 class.