ZED SDK 5.1.2 performing worse than 5.0.5

Hi,
I have been using 5.0.5 for a while with my JetsonOrin NX Jetpack 6.2 and Zed 2i, and it has been working okay with some issues. I updated the SDK to 5.1.2, and it is performing worse. I have attached the params for both cases with results. Please let me know if I am missing something

One more thing to note, when I set 2D mode to true, the pose still moves in the Z axis

ZED SDK 5.1.2 output

ZED SDK 5.0.5 output (close to actual path)

Tried turning ON and OFF loop closure, gravity alignment, the results are the same, happy to provide more info and data if needed

Thanks!

sdk_5_0_5.txt (35.7 KB)

sdk_5_1_2.txt (34.0 KB)