Add tests checking the linearization for kdl compilation #406

Closed developedby closed 1 year ago