V3D predictedRPY = qt.ToEulerRPY(); float predictedRoll = predictedRPY.x; float predictedPitch = predictedRPY.y; ekfState(6) = (float)predictedRPY.z; // yaw
Preview:
downloadDownload PNG
downloadDownload JPEG
downloadDownload SVG
Tip: You can change the style, width & colours of the snippet with the inspect tool before clicking Download!
Click to optimize width for Twitter