Changed clamp wish speed to min wish speed. If wish speed is less than this it will clamp to that. Added horizontal velocity clamp. Set values to constants for better encapsulation and safety.
aj73000
JD