吊舱控制方法、装置、吊舱、无人机及介质.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN113815875A(43)申请公布日2021.12.21(21)申请号202111163017.5(22)申请日2021.09.30(71)申请人北京远度互联科技有限公司地址102100北京市延庆区中关村延庆园风谷四路8号院27号楼1916(72)发明人孙宇徐弘禹(74)专利代理机构深圳市隆天联鼎知识产权代理有限公司44232代理人王丹(51)Int.Cl.B64D47/08(2006.01)B64C39/02(2006.01)权利要求书3页说明书16页附图4页(54)发明名称吊舱控制方法、装置、吊舱、无人机及介质(57)摘要本申请属于无人机技术领域，具体涉及一种吊舱控制方法、装置、吊舱、无人机及介质。本申请的吊舱控制方法，包括：根据无人机相对于大地的姿态信息、吊舱相对于大地的姿态信息和吊舱的预设转轴角计算吊舱的目标转轴角；根据吊舱的目标转轴角和目标转轴角对应的目标电机的零位转子角度计算得出目标电机的估算转子角度；根据目标电机的估算转子角度将目标电机调节至预设转子角度。基于本申请的吊舱控制方法能够实现角度自检，在不需要令吊舱的转轴达到机械限位的情况下就能完成吊舱的角度校准和控制，能够提高吊舱的角度校准和控制的效率。CN113815875ACN113815875A权利要求书1/3页1.一种吊舱控制方法，其特征在于，应用于无人机上的吊舱，所述方法包括：获取所述吊舱的预设转轴角；根据无人机相对于大地的姿态信息、吊舱相对于大地的姿态信息和所述吊舱的预设转轴角计算所述吊舱的目标转轴角；根据所述吊舱的目标转轴角和所述目标转轴角对应的目标电机的零位转子角度计算得出所述目标电机的估算转子角度；根据所述目标电机的估算转子角度将所述目标电机调节至预设转子角度。2.根据权利要求1所述的吊舱控制方法，其特征在于，获取所述吊舱的预设转轴角，包括：调控预设转轴角对应的预设电机以调节所述预设转轴角，使所述预设电机对准吊舱顶板上预设置的标志位；当所述预设电机对准吊舱顶板上预设置的标志位时，停止对所述预设转轴角的调节，并将所述标志位对应的预设角度作为所述吊舱当前的预设转轴角。3.根据权利要求1所述的吊舱控制方法，其特征在于，根据所述吊舱的目标转轴角和所述目标转轴角对应的目标电机的零位转子角度计算得出所述目标电机的估算转子角度，包括：获取所述目标电机对应的磁极对数，并根据所述目标电机的磁极对数计算所述目标转轴角的机械角度与转子角度的换算关系；根据所述吊舱的目标转轴角和所述换算关系计算得到所述目标转轴角对应的目标电机的增量转子角度；将所述目标电机的零位转子角度和所述目标电机的增量转子角度相加得到目标电机的估算转子角度。4.根据权利要求1所述的吊舱控制方法，其特征在于，根据无人机相对于大地的姿态信息、吊舱相对于大地的姿态信息和所述吊舱的预设转轴角计算所述吊舱的目标转轴角，包括：获取所述无人机相对于大地的姿态信息以及所述吊舱相对于大地的姿态信息；根据所述吊舱的预设转轴角确定吊舱的顶板相对于无人机的姿态信息；根据所述顶板相对于无人机的姿态信息以及所述无人机相对于大地的姿态信息确定顶板相对于大地的姿态信息；根据所述顶板相对于大地的姿态信息以及所述吊舱相对于大地的姿态信息，确定吊舱相对于顶板的姿态信息；根据吊舱相对于顶板的姿态信息，确定所述吊舱的目标转轴角。5.根据权利要求4所述的吊舱控制方法，其特征在于，所述根据所述顶板相对于大地的姿态信息以及所述吊舱相对于大地的姿态信息，确定吊舱相对于顶板的姿态信息，包括：对所述顶板相对于大地的姿态信息进行逆变换，以获取大地相对于顶板的姿态信息；根据所述大地相对于顶板的姿态信息以及所述吊舱相对于大地的姿态信息，确定吊舱相对于顶板的姿态信息。6.根据权利要求4所述的吊舱控制方法，其特征在于，获取所述无人机相对于大地的姿态信息以及所述吊舱相对于大地的姿态信息，包括：2CN113815875A权利要求书2/3页从所述无人机上的飞控系统获取所述无人机相对大地的姿态信息；获取所述吊舱上的惯性测量单元IMU检测的所述吊舱相对于大地的姿态信息。7.根据权利要求1所述的吊舱控制方法，其特征在于，根据所述目标电机的估算转子角度将所述目标电机调节至预设转子角度，包括：检测所述目标电机的实际霍尔值，根据所述实际霍尔值以及所述目标电机的估算转子角度确定所述目标电机的实际转子角度；根据所述目标电机的实际转子角度将所述目标电机调节至预设转子角度。8.根据权利要求7所述的吊舱控制方法，其特征在于，根据检测所述目标电机的实际霍尔值，根据所述实际霍尔值以及所述目标电机的估算转子角度确定所述目标电机的实际转子角度，包括：根据所述目标电机的实际霍尔值以及转子角度周期计算得到多个候选转子角度；根据