Fixed debug message printed in publish()
Accept lateral (y) velocity in cmd_vel