Updates to PSO - corrected the velocity lens

Signed-off-by: Gary Pamparà <gpampara@gmail.com>