These lines are buggy
https://github.com/Gepetto/solo-estimation/blob/898eb133cd1b90c26923d2246be47dc6278b45ff/filters.py#L5-L8
You should rather use Pinocchio skew operations.