This was the optimized code suggested by @lilvinz. It seems worth keeping since this the telemetry is so high-frequency. I know that in release the compiler will take care of it, but since so much of what we do is done with GCS debug versions there's a good argument for a optimization at the cost of a tiny bit of readability. But I'll let @lilvinz comment if he thinks there's something more to be said.