Tests: Fix too strict equality test for linearized order goals

With the ordering of operations not necessarily the same in CasADi, the resulting answer can be slightly different. Check for approximate equality instead.