LP constraints

Created by: pFernbach

Add constraints used by the LP formulation and scripts to generate them

Update ROM script to add missing members in the Robot class

Add new reference configuration in fullBody script : with the elbows bended up

Add new weight vector : with high weights on x and y orientation of the root (instead of 0)