1553B中文手册
恩菲特公司的1553B中文手册，手册丰富，详细，是1553B开发者的优选方案成都恩菲特科長有限公司EPH31580日录恩菲特产品保修条款…安全标志符号,D香看看看。。。垂垂看导D看警告第1章芯片概述…11.简介12.EPH31580特性111.3.EPH31580描述……14.电气特性+++··+++++++.1415.功能描述.…1.6.曼彻斯特解码…171.7.吋间戳178.中断19.存储器访问和寄存器访问1.10. BUS CONTROL框架.171.11. REMOTE TERMINAL框架……11.12. BUS MONITOR框榘18第2章软件接口自●●看命·●●●看鲁●息1921.上电状态22.存储器管理23.寄存器定义…21.中断屏敞寄存器(读/写22.配置寄冇器#1(读/23.配置寄存器#2(读/写)24.开始/复位寄存器(写)2.5.BC/RT命令堆栈指针寄存器(读)….262.6.BC控制字尕RT子地址控制宇寄存器(读)…2627.时标寄存器(读/写)28.中断状态寄存器(读29.配置寄存器#3(读/写)……2.10.配置寄冇器#4(读/写)21.配置寄存器#5(读/写)2.12.数据堆栈指针寄存器(读)…322.13.BC下一条消息开始时间寄存器(读/)214.BC帧时间/RT最后一个命令字/BM触发设置寄存器(读/写)2.15.RT状态字寄存器(读)216.RIB字寄存器(读).342.17. BLOCK STATUS WORD第3章 BUS CONTROL OPERATION……38HTTP:www.enpht.comTel:028-851482738528FAX:028-85148287107第3页成都恩菲特科長有限公司EPH31580BC存储器管理…38ACTIVE AREAS DOUBLE BUFFERING38PROGRAMMING OF BC MESSAGE FRAMES39BC Memory managcmcntMessage Block Formats∴39BC控制字∴…42DESCRIPTOR STACK44C MESSAGE GAP TIMEBC FRAME AUTO REPEATMINOR AND MAJOR FRAMES甲甲···:·…46BCⅠ NTERRUPT……46OTUER FUNCTIONBC SOFTWARE INITIALIZATION SEQUENCE··47BC PSEUDO CODE EXAMPLE.49第4章 REMOTE TERMINAL OPERATION,51RT存储器结构51RT存储器管理SUBADDRESS CONTROL WORDRT STACK AND INTERRUPTSTIME TAG WORDDATA BLOCK POINTER OR MODE DATA WORD57COMMAND WORD RECEIVEDRT COMMAND ILLEGALIZATION57SELECTED MODE CODE INTERRUPT60BROADCAST OPT⊥0NBUSY BITRT ADDRESS INPUTS62RT STATUS WORDRT-TO-RT RESPONSE TIMEOUT64SUMMARY OF RESPONSES TO MODE CODE MESSAGESRT SOFTWARE INITIALIZATION PROCEDURERT PSEUDO CODE EXAMPLE.68第5章 BUS MONITOR OPERATION.71MONITUR SELECTION FUNCTIONMESSAGE MONITOR FORMATSBM存储器管理MESSAGE MONITOR BLOCK STATUS WORDBM SOFTWARE INITIALIZATION PROCEDURE,76第6章 EXTERNAL INTERFACES通垂函a看自PIN DESCRIPTIONS BY FUNCTIONAL GROUPS隔离变压器到外部系统的连接BUFFERED u TRANSPARENT MODEHTTP:w.enphtcomTEL:028-851482738528FAX:028-85148287107第4页成都恩菲特科長有限公司EPH31580外部时序接口BUFFERED模式接口时序85与几和典型器件的连接与ADSP2101的连接与68040的连接与80286的连接.环境温度封装形式…订货号附录一:变压器选型手册97HTTP:/ww.enphtcomTEL:028-85148273/8528FAX:028-85148287107第5页成都恩菲特科長有限公司EPH31580恩菲特产品保修条款产品名称:1553A/B协议芯片产品型号:EP-H31580保修期限:一年1.恩菲特公司对由恩菲特公司出售的硬件产品和附件提供质量保修,保修期限如上所示。在保修期内如果出现因质量原因而产生故障,恩菲特公司在收到关于产品故障的通知并经查验核实后,有权选择维修或整套更换产品。整套更换的产品可以是新的或接近新的2.恩菲特公司保证软件产品经过充分测试。如果恩菲特公司在保修期内收到关于软件故障的通知,将在查验核实后免费更换软件3.恩菲特公司不保证在产品修理过程中产品可不中断地使用。但恩菲特公司保证在合理的期限内修理好发生故障的产品4.产品保修期从产品发运之日或由恩菲特公司开始安装之日起开始计算。如果用户的进度安排延后使恩菲特公司在产品发运之日起30天内仍未开始安装,产品保修期从交付之日后的笫31天开始计算5.恩菲特公司对任何下列情况而导致的产品故障和损坏不提供免费保修:(a)错误的使用或不适当的维护和校正,(b)非恩菲特公司提供的软件、接口、部件或其它物品,(c)未经许可的拆卸、修改和错误使用,(a)超过产品技术规格指明的范围使用,(e)不适当的运输、搬运和存贮,(f)其它不可抗力原因造成的故障或损坏(如HTTP:ww.enphtcomTEL:028-851482738528FAX:028-85148287107第6页成都恩菲特科長有限公司EPH31580地震、战争、交通事故等)6.在法律允许的范围内,上述保修条款是唯一明确的,同时没有任何其它的保修条款,不论是书面的或口头的。恩菲特公司明确表示拒绝承认任何暗示的保修条款和商业条款7.如果用户因使用恩菲特公司产品造成对其它物品损坏或身体伤害,经法院裁定其直接原因是恩菲特公司产品缺陷,恩菲特公司对此负责。版权声明所有恩菲特公司出售的软件产品或随同硬件产品出售的软件和文件,其版杈属恩菲特公司所有,恩菲特公司保留软件产品和文件方面的所有版权。用户对产品的购买并不表示用户在版权方面的任何许未经恩菲特公司书面许可的任何复制和出售均是被禁止的成都恩菲特科拈冇限公司HTTP:www.enpht.comTel:028-851482738528FAX:028-85148287107第7页成都恩菲特科長有限公司EPH31580安全标志符号符号说明符号说明贴在产品上的标志符号表示仪器在操作前必须表示使用者必须遵循产品手保证相应的接线端接地册中相应的警告或注意内容良好,以免电击而引起以免造成人身伤害或设备损设备损坏或人身伤害。坏交流直流表示相应的操作危险。△操作员应严格按规定操高压危险。警告作,否则可能导致人身危险表示相应的操作危险操作员应严格按规定操凸⊥机外壳楼地通常与注意,否则可能寻受慢备设备的金属外壳相连接。损坏或永久性数据丢失HTTP:ww.enphtcomTEL:028-851482738528FAX:028-85148287107第8页成都恩菲特科長有限公司EPH31580敬在操作,维护及修理设备的整个过程中要严格遵守以下安全事项违反这些安全规程或任何本手册中警告和注意事项规定的操作导致的设备损坏或人身伤害,恩菲特公司不对此类事故承担责任●对第一类安全设备(具有俣护地接线端子的设各),必须在产品的主电源输入端或供电电源电缆提供一个可靠的安全地连接对于模块式设备,为确保模块安全接地,应将模块前面板上的紧固螺钉旋紧,以保证模块的紧固面板与机箱保护地可靠接通●仪器不应接触易燃易爆气体或在有易燃易爆气体的环境下操作●为了避免火灾,应使用具有相同电压和电流的保险溶丝。不能使用修理过的保险熔丝或短接保险盒●操作人员不应打开机盖。这只能由经过培训的专业技术人员进行。打开机盖是危险的,因为设备中可能存在危险电压。甚至在设备断电以后,高压也可能存在。为了避免人身伤害,应由经过培训的专业技术人员来操作。●不要操作危险设备或在危险的条件下操作设备。如果任何削弱安全性或可能导致安全保护设施失效的情况存在(包括物理损坏,潮湿或别的原因),应立即拔除电源线,直到由专业技术人员确认后方可操作●不要单独维修或调整仪器,以免发生危险时可得到帮助和救治HTTP:www.enpht.comTel:028-851482738528FAX:028-85148287107第9页成都恩菲特科長有限公司EPH31580不能更换或更改产品中的元器件,除非有明确的认可和授权。因为这将带来其它危险。如仪器出了故障,应将其送到恩菲特公司指定的维修点进行维修,从而保证仪器的各项功能文献版本吏新历史所有版本和手册更新及发行时间都列举在下面。手册的初始版本是Ver1.00。不论何时更新手册,版本号都在尾数加1。当更新涉及到较为重要的内容时,版本号中间的数加1,当更新涉及到核心内容时,版本号第一位数加1。更新的内容通过手册发行,包括修改的内容及对手册新增加的内容。新版本均包括了对旧版本更改的内容。每个新版本或更新后版夲都有一页标注该文献的更改情况Ⅴrl.0l..,,,∴,,.,2005.05HTTP:/ww.enphtcomTEL:028-85148273/8528FAX:028-85148287107第10页
- 2021-05-06下载
- 积分：1
VINS论文推倒及代码解析
VINS 的功能模块可包括五个部分:数据预处理、初始化、后端非线性优化、闭环检测及闭环优化。代码中主要开启了四个线程,分别是:前端图像跟踪、后端非线性优化(其中初始化和 IMU 预积分在这个线程中)、闭环检测、闭环优化。、总体框架Measurement PreprocessingInitializationCamera(30hz)Feature Detectionnd rackerVisual-lnertialInitializedis- onlySfMAlignmentIMU (100hMU Pre-integrationLocal Visual-Inertial: OldestSliting WindowNewestNonli+、 Keyframe?OptimizationBundle Adjustment II Loop detectionwith RelocalizationStates from Loop ClosureFealure retrievel oop Deleted二二1---11------22===Global Pose Graph4-DoF Pose Graph OptimizationKeyframe DatabaseOptimization图1VINS框架ⅵINS的玏能模块可包括五个部分:数据预处理、初始化、后端非线性优化、闭环检测及闭环优化。代码中主要开启了四个线稈,分别是:前端图像跟踪、后端非线性伉化(其中初始化和IMU预积分在这个线程中)、闭环检测、闭环优化各个功能模块的作用上要有:1.I图像和MU预处理●图像:提取图像 Harris角点,利用金字塔光流跟踪相邻帧,通过 RANSAC去除异常点,最后将跟踪到的特征点push到图像队列中,并通知后端进行处理●IU:将IMU数据进行积分,得到当前时刻的位置、速度和旋转(PVQ),同时计算在后端优化中将用到的相邻帧的预积分增量,及预积分误差的 Jacobian矩阵和协方差项。1.2初始化首先,利用SFM进行纯视觉佔计滑窗內所有帧的位姿及3D点逆深度,最后与IMU预积分进行对齐求解初始化参数1.3后端滑窗优化将视觉约束、IMU约束和闭环约束放在·个大的目标函数中进行非线性优化,求解滑窗内所有帧的PVQ、bias等。L M States in the sliding windowIMU:k States from loop clos1Camera:冷 MU measurements>visual measurements★ Catur图2滑窗优化示意图14闭环检测和优化利用D)BoW进行闭环检测,当检测成功后进行重定位,最后对整个相机轨迹进行闭环优化。U预积分VisionIMUVision图3MU预积分示意图21当前时刻pVQ的连续形式将第k唢和第kl帧之间的所有IMU进行积分,可得第kHI帧的位置、速度和旋转(PVQ),作为视觉估计的初始值,这里的旋转采用的四元数。v△t+k+1∈[k,k+1]rW(at-ba ) -owletbk JtE[k, k+1]n(,-bdt∈[k,k+1]其中,a2和O为ⅠMU测量的加速度和角速度,是在Body自身坐标系, world坐标系是IMU所在的惯导系,上式的旋转公式推导可参考附录10.1。22当前时刻PVQ的中值法离散形式公式(1)给出的是连续吋刻的相机当前PVR的达代公式,为了跟代码致,下面给出基于中值法的公式,这与 Estimator:; processIMg(O函数中的Ps]、Rs]和Vs是一致的,IMU积分出来的第j时刻的物理量可以作为第j帧图像的初始值。tr t+a26t(2)ka,St其中q(a1-ba)-g"+q:+1(a+1-ba)(a;+o;+1)2.3两帧之间PVQ增量的连续形式通过观察公式(1)可知,IvU的预积分需要依赖与第k帧的ν和R,当我们在后端进行非线性优化时,需要迭代更新第κ唢的ν和R,这将导致我们需要根据每次迭代后值重新进行积分,这将非常耗吋。因此,我们考虑将优化变量从第k帧到第κ+1帧的IU预积分项中分离开来,通过对公式(1)左右两侧各乘Rb,可化简为:R(+p2k-=2△)+ak+1b其中DtElk, k+1t∈[k,k+1R k(at-bar)ldt)Wendtt∈[kk+1这样我们就得到了连续时刻的MU预积分公式,可以发现,上式得到的MU预积分的值只与不同时刻的a2和o相关。这里我们需要重新讨论下公式(5)预积分公式,以ab,为例,我们发现它是与MU的bias相关的,而bias也是我们需要优化的变量,这将导致的问题是,当每次迭代时,我们得到一个新的bias,又得根据公式(巧5)重新对第k帧和第k+1帧之间的IMU预积分,非常耗时。这里假设预积分的变化量与bias是线性关系,可以写成:ab,+/6n6ba+/16b+8 8ba +p(6)k+1sb24两帧之间PVQ增量的欧拉法离散形式面给出离散时刻的IMU预积分公式,首先按照论文中采用的欧拉法,给出第i个MU时刻与第i1个IMU时刻的变量关系为b+1k+的6t+元R(P)(1+R(P")(a2-bbn)δt25两帧之间PⅤQ增量的中值法离散形式卜面给出代码中采用的基」中值法的IMU预积分公式,这与 Estimator: processIMUO函数中的 Integration Base: push backo上是一致的。注意这里跟公式(2)是不一样的,这里积分出来的是前后两顿之间的IU增量信息,而公式(2)给出的当前帧时刻的物理量信息+1+B k St +=a, &tbb+1Bi + au1其中a,=slqilai-bai)+qiDi t aitl2.6连续形式下PVQ增量的误差、协方差及 JacobianIMU在每个吋刻积分出来的值是有误差的,下面我们对误差进行分析。首先我们直接给出在t时刻误差项的导数为:sa00016a000000-82(066hkR;0006|=00-(a-bh)0-1192k|+|000|mLL000016ba00101n000018b000F+ozk+ Gt其中:F25×15,G215×2,62x1,n12×,上式推导可参考附录102。下面我们讨论它的作用,将其可以简写为:6之k=F62z+Gtnt根据导数定义可知:62b=1m24-6262+8=62+628t=(+F6t)6z+(Gt6t)nt(11)这里我们对公式(1)的IMU误差运动方程再说明,将上式和EKF对比可知,上式恰好给出了如EKF一般对非线性系统线性化的过程,这里的意义是表示下一个时刻的IMU测量误差与上一个时刻的成线性关系,这样我们根据当前时刻的值,可以预测出下一个时刻的均值和协方差,而公式(1)给出的是均值预测,协方差预测公式如下Pb+6=(1+Ft)P(+Fl6t)7+(G,t)Q(G18t)ot(12)上式给出了协方差的选代公式,初始值Pk=0。其中,Q为表示噪声项的对角协方差矩阵000003000另外根据(11)式可获得诀差项的 Jacobian的迭代公式:(I+F26t)(14)其中 Jacobian的初始值为bk=12.7离散形式的PVQ增量误差分析我们首先直接给出PVQ增量误差在离散形式下的矩阵形式,为了与代码一致,我们修改下变量顺序,这和代码中 midPointIntegration(函数是一致的。(但不知为何计算的V中与前四个噪声项相关的差个负号?)1t fo660f106t‖loeBk+1=0f211f20016bδb0[6b102001rnot000kRkotk+1(15006t0n0000δt其中,推导可参考附录10.3:stE(ak-ba)02-4B+1(kk+121k+1b.)6t|6t2(Rr+ rk+18t2Stn=71=Rk+1(a+1-b)6tWr+ wf1=Ik+11+Gb。)δt-Rn+1(ak+121=-2配+1Stl st21(RK+Ruts)4rula1RrotstStR+1(a1R,+114/+11t28离散形式的PVQ增量误差的 Jacobian和协方差将公式(15)简写为:k+1F15×158215×1+V15×13Q则 Jacobian的迭代公式为k+15×15=F/k(16)其中, Jacobian的初始值为/k=l。这里计算出来的k+1只是为了给后面提供对bias的acoblar。协方差的迭代公式为P+15×15=FPFr+vQv(17)其中,初始值P=0。Q为表示噪声项的对角协方差矩阵:00000000aa000Q18×180a00(18)000000三、后端非线性优化31状态向量状态向量共包括滑动窗口内的n+l1个所有相机的状态(包括位置、朝向、速度、加速度计bias和陀螺仪bias)、 Camera到IMU的外参、m+1个3D点的逆深度X=[xr=pw,vb bpc,q3.2目标函数吗+(喻,2)+2(19)其中三个残差项即误差项分别为边缘化的先验信息、IMU测量残差、视觉的重投影残差。三种残差都是用马氏距离表示。根据《十四讲》中高斯牛顿法,若要计算目标函数的最小值,可以理解为,当优化变量有一个增量后,目标函数值最小,以IU残差为例,可写成如下所示:nin lre2bk, X+8Xrk x)+HSⅩDk+1oXk+1k+1其中HB,为B关于 XIK Jacobian,将上式展开并令关于6X的导数为0,可得增量δx的计算公式:H k 8X=k+1TB那么,公式(28)可写成+∑+∑Tk∑1rc上式中,B为MU预积分噪声项的协方差,P为vual观测的噪声协方差。当MU的噪声协方差P越大时,其信息矩阵Pk,将越小,意味着该MU观测越不可信,换句话说,因MU噪声较大,越不可信IMU预积分数据,而更加相信 visual观测。注意,这里的IMU和vsua协方差的绝对值没有意义,因为考虑得是两者的相对性可将上式继续简化为:(Ap+AB +Acox=bp +bB +bc其中,Ap,AB和Ac为 Hessian矩阵,上述方程称之为增量方程。33MU约束1)残差:两帧之间的PVQ和bias的变化量的差△tx+k+1bk qbk+1bR+1 xyz+g"△t)-Bk(20)sbbbb其中各增量关于bias的 Jacobian可从公式(16)的大 Jacobian中的相应位置获得。上面与代码中 Integration base: evaluateD对应,2)优化变量pb, 0W, Svb ,8ba:,bor Opb,, 80W ,Swb,, bakr, Sba3)Jacobian:计算 Jacobian时,残差对应求偏导对象分别为p6e,6vB,6h,ba],6b,6b
- 2020-12-07下载
- 积分：1
