PSINS中的AVP
PSINS工具箱里面的trj.avp、trj.avp0等中的avp指的是姿態(attitude)、速度(velocity)和位置(position),最后加一個時間戳t:
avp=[att; vn; pos; t]。
姿態
姿態的構成為:俯仰角pitch+橫滾角roll+偏航角yaw。單位為弧度
速度
速度的構成為:東向速度+北向速度+天向速度。單位為m/s
位置
位置的構成為:緯度+經度+高度。其中緯度和經度的單位均為度,高度的單位為m
附:工具箱自帶的解釋
function avp = avpset(att, vn, pos, isdeg)
% avp=[attitude; velocity; position] setting.
%
% Prototype: avp = avpset(att, vn, pos)
% Inputs: att - attitude in deg
% vn - velocity in m/s
% pos - postion=[lat;lon;height] with lat and lon in deg,
% while heigth in m. see posset.
% isdeg - unit deg flag
% Output: avp=[attitude; velocity; position]
%
% See also posset, avpchk, avperrset, avpadderr, insupdate.% Copyright(c) 2009-2014, by Gongmin Yan, All rights reserved.
% Northwestern Polytechnical University, Xi An, P.R.China
% 08/03/2014, 22/01/2021
function avperr = avperrset(phi, dvn, dpos)
% avp errors setting.
%
% Prototype: avperr = avperrset(phi, dvn, dpos)
% Inputs: phi - platform misalignment angles. all in arcmin
% dvn - velocity errors in m/s
% dpos - position errors dpos=[dlat;dlon;dhgt], all in m
% Output: avperr = [phi; dvn; dpos]
%
% See also poserrset, vperrset, avpadderr, imuerrset, avpset, insupdate, avperrstd.% Copyright(c) 2009-2014, by Gongmin Yan, All rights reserved.
% Northwestern Polytechnical University, Xi An, P.R.China
% 08/03/2014
global glvavperr = [rep3(phi)*glv.min; vperrset(dvn,dpos)];