CasADi liecasadi implements Lie groups operation written in CasADi liecasadi implements Lie groups operation written in CasADi 20 January 2022