Got a new version of the polar model working

Uses the minimal state and actuation representation in each phase. Based
on a polar derivation of the EoM, using newton-euler equations.