wou_stepgen.c: cleanup code
wou_stepgen.c: cleanup code

araisrobo/machinekit,araisrobo/machinekit,araisrobo/machinekit,EqAfrica/machinekit,EqAfrica/machinekit,araisrobo/machinekit,araisrobo/machinekit,EqAfrica/machinekit,EqAfrica/machinekit,EqAfrica/machinekit,araisrobo/machinekit,EqAfrica/machinekit,EqAfrica/machinekit,araisrobo/machinekit,EqAfrica/machinekit,araisrobo/machinekit,araisrobo/machinekit