%% calculate heading with corrected magData function yaw = CompassCalculateHeading(mag,dcm) cos_pitch_sq = 1.0 - dcm(3,1)*dcm(3,1); hy = mag(2) * dcm(3,3) - mag(3) * dcm(3,2); hx = mag(1) * cos_pitch_sq - dcm(3,1)*(mag(2) * dcm(3,2) + mag(3)*dcm(3,3)); yaw = getYawFromMag([hx,hy,0]); end
此处可能存在不合适展示的内容,页面不予展示。您可通过相关编辑功能自查并修改。
如您确认内容无涉及 不当用语 / 纯广告导流 / 暴力 / 低俗色情 / 侵权 / 盗版 / 虚假 / 无价值内容或违法国家有关法律法规的内容,可点击提交进行申诉,我们将尽快为您处理。