Generalized preview for angles and inequality constraints.
It is not necesary to receive the vel ref, just a flag to know if it has already the reference.
It not necesarily compiles.