Fixed DH so Motor angle are coherent between Fixed right of left legs.
Added generation or fixed foot in generate trajectory to be more felxible