add a visualizer to the FixedFootYawCoMPlanning. In the CoM trajectory, the highest order has large coefficient, meaning that the CoM trajectory oscillates wildly between knot points. This is a bad sign. I will try using lower order of polynomial and bypass the bilinear alternation