Added normalised velocity clamping

Normalised velocity clamping, as opposed to Vmax clamping, preserves the direction of the velocity vector.

Signed-off-by: Anna Rakitianskaia <annar@cs.up.ac.za>