Trouble programming sensor reading

[PapercutSmothie]

I'm trying to get the accelerometer read by my custom code and right now, it is outputting bad, not-updated data despite looking like it should be updating.

Here is the code

static void dbgMessagerTask(void* parameters)
{
    Axis3f acc;
    while (true)
    {
        if (sensorsAreCalibrated())
        {
            // Read accelerometer values 
            sensorsReadAcc(&acc);

            consolePrintf("Acc: (%f,%f,%f) \n", 
                (double) acc.x, 
                (double) acc.y,
                (double) acc.z
            );
            sensorsResume();

        }

        //delay
        vTaskDelay(50);
    }
}

What am I missing that will make it work?

[ToveRumar]

Hi @PapercutSmothie !

Its looking like the queue where sensor data is stored might be empty when you fetch data from it.
If the queue is empty it the function will return false, and the struct will not be filled with data.
You will then just print junk.
From the stabilizer task the sensors are continuously read, so it looks like you thread is getting priority after that thread, if you are constantly getting the same junk data.
I would suggest checking the return value first to see if its false.

If so you could take several different approaches.
You could change the code so that the stabilizer task just peeks the data and this one reads, or print after the stabilizer task reads the data, if its only the prints you are looking for.

I hope you got the clarification you needed to make this work!