AWR1642BOOST: Parsing internally TLV of detected objects in SDK 3.4

Hello,

I'm modifying the Short Range Radar project example so that I can internally parse the objects' cartesian coordinates and controll some pins when an object surpases a defined distance.

So I have modified the MmwDemo_mboxReadTask fuction so that when the DSP sends a MMWDEMO_DSS2MSS_DETOBJ_READY message I can parse the coordinates of the object.

The problem is that I'm reading incoherent information in the TLVs. The SSR demo visualizer shows correclty the objects in the UI:

But when debugging I obtain this data from the TLV:

I don't know what I'm doing wrong. This is the piece code I'm debugging in mss_main:

I hope someone can help me with the issue,

Thank you in advance!