Allow zero velocity to be valid ( test fixes ) (#1825)

* Moved the zero velocity check to higher level(xy_theta_iterator)

* Moved valid speed check from kinematic params to xy theta itearator

* Fixed code styling.

* linted the cpp code

* Revert "linted the cpp code"

This reverts commit fb1a74b6dea99c52114739a1861a01d6f3494801.

* Revert "Fixed code styling."

This reverts commit bd82113a52a6418edd7b9ea41f102ce539a83784.

* Fixed style and small bug

Signed-off-by: Aitor Miguel Blanco <aitormibl@gmail.com>

* Style fix

Signed-off-by: Aitor Miguel Blanco <aitormibl@gmail.com>

Co-authored-by: Gokul <astrogok@gmail.com>