Debug linearProg 3 et 1 + update BodyVelocity

correction bug(NaN et nullPointer lié à mauvais code pour traduire le
continue)
=> moins cool les agents se tapent entre eux