技术领域
[0001] 本
发明涉及控制技术领域,尤其涉及一种航向修正方法、设备及飞行器。
背景技术
[0002] 近几年随着
无人飞行器的发展,其已被广泛的应用到各行各业。针对无人飞行器的控制
精度的要求越来越高。在无人飞行器的控制过程中,有一个常规的控制操作:无人飞行器接收控制终端发送的航向控制指令,无人飞行器根据接收到的航向控制指令,保持当前的
位置不变,改变无人飞行器的航向,即控制无人飞行器进行航向运动。
[0003] 然而,目前针对该控制操作,在无人飞行器持续改变航向的过程中,因
传感器(例如
加速度计)的安装误差导致输出的数据存在偏差,会出现使无人飞行器的
水平方向上有速度的情况。这就导致无人飞行器在改变航向的过程中,实际表现并不仅仅是调转航向,同时还伴随着绕一个位置点以较小的半径环绕飞行的现象,降低了无人飞行器保持原地不动只调转航向的性能。
发明内容
[0004] 有鉴于此,本发明
实施例提供一种航向修正方法、设备及飞行器,以有效提升无人飞行器保持原地不动只调转航向的性能。
[0005] 为实现上述目的,本发明实施例提供如下技术方案:
[0006] 本发明实施例的一个方面是提供一种航向修正方法,包括:
[0007] 在飞行器进行航向运动过程中,获取当前时刻所述飞行器在水平方向的飞行速度,获取所述飞行器的加速度数据;
[0008] 根据所述当前时刻的飞行速度对所述加速度数据进行修正以得到修正后的加速度数据;
[0009] 根据所述修正后的加速度数据对所述飞行器在水平方向的飞行速度进行控制以使得下一时刻所述飞行器在水平方向的飞行速度小于当前时刻所述飞行器在水平方向的飞行速度。
[0010] 本发明实施例的另一个方面是提供一种航向修正设备,包括:速度传感器、加速度计和处理器;
[0011] 所述速度传感器,用于在飞行器进行航向运动过程中,获取当前时刻所述飞行器在水平方向的飞行速度;
[0012] 所述加速度计,用于在飞行器进行航向运动过程中,获取所述飞行器的加速度数据;
[0013] 所述处理器,用于根据所述当前时刻的飞行速度对所述加速度数据进行修正以得到修正后的加速度数据;以及根据所述修正后的加速度数据对所述飞行器在水平方向的飞行速度进行控制以使得下一时刻所述飞行器在水平方向的飞行速度小于当前时刻所述飞行器在水平方向的飞行速度。
[0014] 本发明实施例的另一个方面是提供一种飞行器,包括:
[0016] 动
力系统,安装在所述机身,用于提供飞行动力;
[0017] 以及上述的航向修正设备。
[0018] 基于上述发明实施例提供的一种航向修正方法、设备及飞行器,通过在飞行器进行航向运动的过程中,获取当前时刻飞行器在水平方向的飞行速度以及飞行器的加速度数据,并根据该当前时刻的飞行速度对飞行器的加速度进行修正以得到修正后的加速度数据,并根据该修正后的加速度数据对该飞行器在水平方向的飞行速度进行控制以使得下一时刻该飞行器在水平方向的飞行速度小于当前时刻飞行器在水平方向的飞行速度。通过上述航向修正过程,在飞行器进行航向运动时,可以有效地减小飞行器在水平方向上的速度,即减小飞行器绕某一位置点环绕飞行的半径,提升无人飞行器保持原地不动只调转航向的性能,从而提高飞行器在行业应用中的灵活性和安全性。
附图说明
[0019] 为了更清楚地说明本发明实施例或
现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
[0020] 图1为本发明实施例提供的无人飞行器F绕A点旋转的飞行轨迹示意图;
[0021] 图2为本发明实施例提供的航向修正方法的
流程图;
[0022] 图3为本发明实施例提供的
机体坐标系OXYZ的示意图;
[0023] 图4为本发明另一实施例提供的航向修正方法的流程图;
[0024] 图5为本发明另一实施例提供的航向修正方法的流程图;
[0025] 图6为本发明另一实施例提供的航向修正方法的流程图;
[0026] 图6A为本发明实施例提供的一种以加速度的Y轴为轴线对加速度数据进行旋转变换的示意图;
[0027] 图6B为本发明实施例提供的以加速度的X轴为轴线对旋转变化的加速度数据进行旋转变换的示意图;
[0028] 图7为本发明实施例提供的一种航向修正设备的结构图;
[0029] 图8为本发明另一实施例提供的航向修正设备的结构图;
[0030] 图9为本发明实施例提供的无人飞行器的结构图;
[0031] 附图标记:
[0032] F-无人飞行器 700-航向修正设备 701-速度传感器 702-加速度计
[0033] 703-处理器 704-通讯
接口 901-机身 902-动力系统
[0034] 903-航向修正设备 1000-控制终端。
具体实施方式
[0035] 下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
[0036] 需要说明的是,当组件被称为“固定于”另一个组件,它可以直接在另一个组件上或者也可以存在居中的组件。当一个组件被认为是“连接”另一个组件,它可以是直接连接到另一个组件或者可能同时存在居中组件。
[0037] 除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的
说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。本文所使用的术语“及/或”包括一个或多个相关的所列项目的任意的和所有的组合。
[0038] 下面结合附图,对本发明的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。
[0039] 在飞行器,尤其是无人飞行器中,在进行航向控制的过程,用户通过对控制终端的航向按键、航向杆向飞行器发出航向控制指令,以使飞行器在保持当前位置不变的前提下,调转飞行器的航向。
[0040] 如图1所示,理想状态下,在接收到控制终端发送的航向控制指令时,无人机飞行器根据控制指令调转航向,即在无人机飞行器的航向运动过程中,无人飞行器当前保持自身位置不变,仅仅是在进行航向运动,自身位置不会发生变化,水平方向的速度应该为0。也就是说,无人飞行器在水平方向上不会有速度。但是,在实际的情况中,由于传感器的安装误差,使得传感器输出的数据存在偏差,无人飞行器的处理器根据存在偏差的输出数据去对无人飞行器进行控制,导致无人飞行器在进行航向运动的过程中水平方向的速度不为0,即表现出如图1所示的,无人飞行器F以A位置点为圆心以一个较小的半径环绕飞行器,表现出原地画圈的现象。
[0041] 因此,为了有效提升无人飞行器保持原地不动只调转航向的性能,提高飞行器在行业应用中的灵活性和安全性。本发明实施例公开了一种航向修正的技术方案。
[0042] 图2为本发明实施例提供的航向修正方法的流程图。下面结合图2,详细描述本发明实施例提供的用于航向修正的方法,以有效提升无人飞行器保持原地不动只调转航向的性能。如图2所示,本实施例中的方法,可以包括:
[0043] 步骤S201、在飞行器进行航向运动过程中,获取当前时刻所述飞行器在水平方向的飞行速度。
[0044] 本实施例中,该步骤S201的执行主体可以是具有观测飞行器在水平方向上的飞行速度的速度传感器;其中,所述速度传感器是任何可以观测飞行器在水平方向上的飞行速度的传感器,例如视觉传感器(单目视觉传感系统、双目
立体视觉传感系统)、TOF相机、雷达、
激光雷达、GPS等,在这里不作具体的限定。
[0045] 这里需要说明的是,图3为机体坐标系的示意图,当飞行器只做航向运动时,飞行器的机体坐标的XOY平面与水平面平行,所述水平方向的速度包括该机体坐标系下X轴方向的飞行速度和X轴方向的飞行速度。
[0046] 步骤S202、在飞行器进行航向运动过程中,获取所述飞行器的加速度数据。
[0047] 本实施例中,该步骤S202的执行主体为加速度计,其中本发明实施例中的加速度计是表示任何可以感测加速度的传感器。加速度计可以为单轴加速度计、两轴加速度计、三轴加速度计。
[0048] 这里以三轴加速度计来进行示意性说明,目前,加速度计和
陀螺仪往往集成为一个模
块、即惯性测量单元(IMU),固定安装在无人飞行器的机身内部。
[0049] 另外,本实施例需要说明的是,步骤S201和步骤S202之间无先后执行顺序,在飞行器工作期间,各自执行速度和加速度的获取。
[0050] 步骤S203、根据所述当前时刻的飞行速度对所述加速度数据进行修正,以得到修正后的加速度数据。
[0051] 本实施例中,该步骤S203的执行主体为处理器。该处理器可以为无人飞行器的
飞行控制系统,也可以是其他专用或通用的具有
数据处理能力的处理器,这里并不作具体限定。
[0052] 当加速度计的安装状态为理想安装状态时,即加速度计没有任何安装误差,加速度的X轴和Y轴构成的XOY平面与水平面平行,加速度计的坐标系应当与无人飞行器的机体坐标系应当是完全相同,此时,当无人飞行器在进行航向运动时,加速度计的输出的加速度数据应当为0,即在加速度计的三轴(X轴、Y轴和Z轴)方向的输出的加速度数据应当都为0。然而,由于加速度计的存在安装误差,导致加速度计的三轴(X轴、Y轴和Z轴)方向的输出的加速度数据不全为0,加速度计输出的加速度数据存在误差。由于加速度计输出的加速度速度是对无人飞行器的速度进行控制的重要参数,如前所述,加速度计输出的加速度数据存在误差,因此,需要对加速度计的加速度输出数据进行修正,以得到修正后的加速度数据。
[0053] S204、根据所述修正后的加速度数据对所述飞行器在水平方向的飞行速度进行控制,以使得下一时刻所述飞行器在水平方向的飞行速度小于当前时刻所述飞行器在水平方向的飞行速度。
[0054] 本实施例中,该步骤S204的执行主体为如上所述的处理器。基于上述说明,在处理器得到修正后的加速度数据后,即可根据该修正后的加速度数据对飞行器在水平方向的飞行速度进行控制,修正后的加速度数据相对比修正前的加速度数据,减小了加速度数据的误差,这样使飞行器下一时刻在水平方向的飞行速度小于当前时刻飞行器在水平方向上的飞行速度,通过这种方式可以有效减小无人飞行器在水平方向上的速度大小。
[0055] 其中,在本发明实施例中,上述所涉及到的控制终端可以为遥控器、智能手机、
平板电脑、地面控制站、膝上型电脑、穿戴式设备(
手表、手环)等及其组合。
[0056] 本实施例通过在飞行器进行航向运动的过程中,获取当前时刻飞行器在水平方向的飞行速度以及飞行器的加速度数据,并根据该当前时刻的飞行速度对飞行器的加速度进行修正,以得到修正后的加速度数据,并根据该修正后的加速度数据对该飞行器在水平方向的飞行速度进行控制,以使得下一时刻该飞行器在水平方向的飞行速度小于当前时刻飞行器在水平方向的飞行速度。通过上述航向修正过程,在飞行器进行航向运动时,可以有效地减小飞行器在水平方向上的速度,即减小飞行器绕某一位置点环绕飞行的半径,使飞行器在进行航向运动的过程中保持原地不动,提升无人飞行器保持原地不动只调转航向的性能,从而提高飞行器在行业应用中的灵活性和安全性。
[0057] 本发明实施例提供了一种航向修正方法。在图2示出的实施例的
基础上,图4为本发明另一实施例提供的航向修正方法的流程图。本实施例中的方法,包括:
[0058] S401、接收控制终端发送的航向控制指令,根据所述航向控制指令控制飞行进行航向运动。
[0059] 在本实施例中,用户通过控制终端向无人飞行器发送航向控制指令,例如,用户操作控制终端的航向杆,控制终端就会向无人飞行器发送航向控制指令,无人飞行器在接收到所述航线控制指令后,根据所述控制指令调转航向,即根据所述航向控制指令进行航向运动。
[0060] S402、在飞行器进行航向运动过程中,获取当前时刻所述飞行器在水平方向的飞行速度。
[0061] 在本实施例中,步骤S402的执行主体和执行原理与图2示出的实施例中的步骤S201一致,具体说明可参照本发明上述实施例中对步骤S201的说明,这里不再进行赘述。
[0062] 需要说明的是,基于上述图3示出的机体坐标系可知,在本实施例中,所述飞行器在水平方向的飞行速度包括所述飞行器在机体坐标系下的X轴方向的速度、Y轴方向的速度。
[0063] S403、在飞行器进行航向运动过程中,获取所述飞行器的加速度数据。
[0064] 在本实施例中,步骤S403的执行主体和执行原理与图2示出的实施例中的步骤S202一致,具体说明可参照本发明上述实施例中对步骤S202的说明,这里不再进行赘述。
[0065] S404、若所述当前时刻的飞行速度不在预设范围内时,对所述加速度数据进行修正,以得到修正后的加速度数据。
[0066] 在本实施例中,在处理器获取到当前时刻的飞行速度时,处理器可以将所述飞行速度与预设的速度
阈值进行比较,判断所述飞行速度是否在预设的范围内,具体地,当所述飞行速度大于或等于预设飞行速度阈值时,即所述当前时刻的飞行速度不在预设范围内时,表示无人飞行器在水平方向的飞行速度较大,在进行航向运动时,无人飞行器保持自身位置不变的性能较差,需要对加速度计输出的加速度数据进行修正,根据修正后的加速度对飞行速度进行控制以使无人飞行器在水平方向上的飞行速度降低;当所述飞行速度小于预设飞行速度阈值时,即所述当前时刻的飞行速度在预设范围内时,表示无人飞行器在水平方向的飞行速度较小,在进行航向运动时,无人飞行器保持自身位置不变的性能较好,不需要对加速度计输出的加速度数据进行修正。
[0067] 进一步地,若所述当前时刻的飞行速度不在预设范围内时包括:若当前时刻的机体坐标系下的X轴方向的速度、Y轴方向的速度不在预设范围内时。具体地,若当前时刻的机体坐标系下的X轴方向的速度、Y轴方向的速度大于或等于预设的速度阈值时,即当前时刻的机体坐标系下的X轴方向的速度、Y轴方向的速度不在预设范围内,例如,当前时刻的机体坐标系下的X轴方向的速度、Y轴方向的速度大于或等于3cm/s时,表示无人飞行器在水平方向的飞行速度较大,在进行航向运动时,无人飞行器保持自身位置不变的性能较差,需要根据如前所述的方法对水平方向上的飞行速度进行控制。当所述前时刻的机体坐标系下的X轴方向的速度、Y轴方向的速度小于预设飞行速度阈值时,即当前时刻的机体坐标系下的X轴方向的速度、Y轴方向的速度在预设范围内,例如,当前时刻的机体坐标系下的X轴方向的速度、Y轴方向的速度小于3cm/s时,表示无人飞行器在水平方向的飞行速度较小,在进行航向运动时,无人飞行器保持自身位置不变的性能较好,不需要对加速度计输出的加速度数据进行修正。
[0068] 需要说明的是,取3cm/s为预设的速度阈值只是为了进行示意性说明,本领域技术人员还可以选用其他的速度阈值,在此不作具体的限定。
[0069] S405、根据所述修正后的加速度数据对所述飞行器在水平方向的飞行速度进行控制,以使得下一时刻所述飞行器在水平方向的飞行速度小于当前时刻所述飞行器在水平方向的飞行速度。
[0070] 在本实施例中,步骤S405的执行主体和执行原理与图2示出的实施例中的步骤S204一致,具体说明可参照本发明上述实施例中对步骤S204的说明,这里不再进行赘述。
[0071] 本发明实施例提供了一种航向修正方法。在图2、4示出的实施例的基础上,图5为本发明另一实施例提供的航向修正方法的流程图。本实施例中的方法,包括:
[0072] S501、在飞行器进行航向运动过程中,获取当前时刻所述飞行器在水平方向的飞行速度。
[0073] 在本实施例中,步骤S501的执行主体和执行原理与图2示出的实施例中的步骤S201一致,具体说明可参照本发明上述实施例中对步骤S201的说明,这里不再进行赘述。
[0074] 需要说明的是,基于上述图3示出的机体坐标系可知,在本实施例中,所述飞行器在水平方向的飞行速度包括所述飞行器在机体坐标系下的X轴方向的速度、Y轴方向的速度。
[0075] S502、在飞行器进行航向运动过程中,获取所述飞行器的加速度数据。
[0076] 在本实施例中,步骤S502的执行主体和执行原理与图2示出的实施例中的步骤S202一致,具体说明可参照本发明上述实施例中对步骤S202的说明,这里不再进行赘述。
[0077] S503、根据所述当前时刻的飞行速度对加速度数据进行修正以得到修正后的加速度数据。
[0078] S504、根据所述修正后的加速度数据对飞行器在水平方向的飞行速度进行控制以使得下一时刻飞行器在水平方向的飞行速度小于当前时刻飞行器在水平方向的飞行速度。
[0079] S505、重复上述步骤,直至飞行器在水平方向的速度在预设范围内。
[0080] 在本实施例中,步骤S501-S504是根据修正后的加速度数据对无人飞行器在水平方向上的飞行速度进行控制的一次操作,在所述下一时刻时(当到达下一时刻时,此时的下一时刻即为步骤S501-S504中的当前时刻),重复执行步骤S501-S504,直至在下一时刻时,速度传感器输出的无人飞行器在水平方向上的飞行速度在预设范围内时为止,例如直至飞行器在机体坐标系下的X轴方向的速度、Y轴方向的速度都小于3cm/s为止。这样多次利用修正后的加速度数据对无人飞行器在水平方向上的速度进行控制,无人飞行器在水平方向上的飞行速度逐渐减小,无人飞行器在进行航向运动时,保持自身位置不变的性能逐步提升。当无人飞行器在水平方向上的飞行速度小于预设的速度阈值时,则认为无人飞行器在进行航向运动时,保持自身位置不变的性能已经达到预设的要求。
[0081] 本发明实施例提供了一种航向修正方法。在图2、4、5示出的实施例的基础上,图6为本发明另一实施例提供的航向修正方法的流程图。本实施例中的方法,包括:
[0082] S601、在飞行器进行航向运动过程中,获取当前时刻所述飞行器在水平方向的飞行速度。
[0083] 在本实施例中,步骤S601的执行主体和执行原理与图2示出的实施例中的步骤S201一致,具体说明可参照本发明上述实施例中对步骤S201的说明,这里不再进行赘述。
[0084] 需要说明的是,基于上述图3示出的机体坐标系可知,在本实施例中,所述飞行器在水平方向的飞行速度包括所述飞行器在机体坐标系下的X轴方向的速度、Y轴方向的速度。
[0085] S602、在飞行器进行航向运动过程中,获取所述飞行器的加速度数据。
[0086] 在本实施例中,步骤S602的执行主体和执行原理与图2示出的实施例中的步骤S202一致,具体说明可参照本发明上述实施例中对步骤S202的说明,这里不再进行赘述。
[0087] S603、若所述当前时刻的飞行速度不在预设范围内时,确定旋转
角度,对加速度数据进行旋转修正以得到修正后的加速度数据。
[0088] 具体地,确定旋转角度,根据所述旋转角度对所述加速度数据进行旋转修正以得到修正后的加速度数据,可以通过如下几种可行方式实现:
[0089] 第一种可行方式为:
[0090] 根据所述当前时刻飞行器在水平方向的飞行速度确定当前时刻的旋转角度,根据所述旋转角度对加速度数据进行旋转修正以得到修正后的加速度数据。其中,每一次对加速度数据进行旋转修正时,旋转角度是根据飞行速度来确定的,所述当前时刻飞行器在水平方向的飞行速度包括当前时刻飞行器在机体坐标系下X轴方向的飞行速度和X轴方向的飞行速度。
[0091] 进一步地,根据机体坐标系下的X轴方向的速度确定当前时刻的第一旋转角度,根据机体坐标系下的Y轴方向的速度确定当前时刻的第二旋转角度;根据所述第一旋转角度和第二旋转角度对所述加速度数据进行旋转修正以得到修正后的加速度数据。
[0092] 下面将详细介绍根据机体坐标系下的X轴方向的速度确定当前时刻的第一旋转角度,根据机体坐标系下的Y轴方向的速度确定当前时刻的第二旋转角度的过程:
[0093] 根据机体坐标系下的X轴方向的速度确定当前时刻的第一旋转角度修正量,根据第一旋转角度修正量和当前时刻的前一时刻的第一旋转角度确定当前时刻的第一旋转角度;根据机体坐标系下的Y轴方向的速度确定当前时刻的第二旋转角度修正量,根据第二旋转角度修正量和当前时刻的前一时刻的第二旋转角度确定当前时刻的第二旋转角度。例如,在k=0时刻时,获取当前时刻的X轴方向的飞行速度Vx0、Y轴方向的飞行速度Vy0和加速度计输出的加速度数据,当前时刻的飞行速度Vx0、Vy0不在预设范围内时,根据Vx0确定第一旋转角度修正量k*Vx0,第一旋转角度为αx0=k*Vx0,根据Vy0确定第二旋转角度修正量k*Vy0,第二旋转角度为αy0=k*Vy0,根据第一旋转角度αx0和第二旋转角度αy0对加速度数据进行旋转变换,得到修正后的加速度数据,根据修正后的加速度数据对飞行速度进行控制以使k=1时刻的飞行速度小于当前时刻的飞行速度;
[0094] 在k=1时刻时,获取当前时刻的X轴方向的飞行速度Vx1、Y轴方向的飞行速度Vy1和加速度计输出的加速度数据,当前时刻的飞行速度Vx1、Vy1不在预设范围内时,根据Vx1确定第一旋转角度修正量k*Vx1,第一旋转角度为k=0时刻的旋转角度和当前时刻的第一旋转角度修正量之和,即αx1=αx0+k*Vx1,根据Vy1确定第二旋转角度修正量k*Vy1,第二旋转角度为k=0时刻的旋转角度和当前时刻的第二旋转角度修正量之和,即αy1=αy0+k*Vy1,根据第一旋转角度αx1和第二旋转角度αy1对加速度数据进行旋转变换,得到修正后的加速度数据,根据修正后的加速度数据对飞行速度进行控制以使k=1时刻的飞行速度小于当前时刻的飞行速度;
[0095] 在k=2时刻时,获取当前时刻的X轴方向的飞行速度Vx2、Y轴方向的飞行速度Vy2和加速度计输出的加速度数据,当前时刻的飞行速度Vx2、Vy2不在预设范围内时,根据Vx2确定第一旋转角度修正量k*Vx2,第一旋转角度为k=1时刻的旋转角度和当前时刻的第一旋转角度修正量之和,即αx2=αx1+k*Vx2,根据Vy2确定第二旋转角度修正量k*Vy2,第二旋转角度为k=1时刻的旋转角度和当前时刻的第二旋转角度修正量之和,即αy2=αy1+k*Vy2,根据第一旋转角度αx2和第二旋转角度αy2对加速度数据进行旋转变换,得到修正后的加速度数据,根据修正后的加速度数据对飞行速度进行控制以使k=3时刻的飞行速度小于当前时刻的飞行速度;
[0096] 以此类推,知道下一时刻的飞行速度在预设范围内,即直到下一时刻的飞行速度小于预设的速度阈值。
[0097] 需要说明的是,本发明实施例中旋转角度的修正量为预设的k与飞速度的乘积只是一种实现方式,本领域技术人员还可以采用其他方式根据飞行速度确定旋转角度的修正量,在这里不做具体的限定。
[0098] 进一步地,根据所述第一旋转角度和第二旋转角度对所述加速度数据进行旋转修正,以得到修正后的加速度数据。具体地,存在以下几种可行的方式:
[0099] 一种可行方式:以加速度计的Y轴为旋
转轴线,将所述加速度数据按照第一旋转角度进行旋转变换以得到旋转变换后的加速度数据;以加速度计的Y轴为
旋转轴线,将所述旋转变换后的加速度数据按照第二旋转角度进行旋转变换以得到所述修正后的加速度数据。
[0100] 具体地,如图6A所示,当前时刻加速度计输出的加速度数据为(ax,1,ay,1,az,1),当前时刻确定的第一旋转角度为α,以加速度的Y轴为旋转轴线,根据第一旋转角度α对加速度数据进行旋转变换,得到旋转变换的加速度数据(ax,1cosα-az,1sinα,ay,1,ax,1sinα+az,1cosα),具体的旋转变换方式如下:
[0101]
[0102] 如图6B所示,当前时刻确定的第一旋转角度为β,在得到旋转修正的加速度数据(ax,1cosα+az,1sinα,ay,1,-ax,1sinα+az,1cosα)后,以加速度的X轴为旋转轴线,根据第一旋转角度β对所述旋转变换后的加速度数据进行旋转修正,得到旋转修正的加速度数据,具体的旋转变换方式如下:
[0103]
[0104] 另一种可行方式:以加速度计的X轴为旋转轴线,将所述加速度数据按照第二旋转角度进行旋转变换以得到旋转变换后的加速度数据;以加速度计的Y轴为旋转轴线,将所述旋转变换后的加速度数据按照第一旋转角度进行旋转变换以得到所述修正后的加速度数据。
[0105] 具体地,当前时刻加速度计输出的加速度数据为(ax,1,ay,1,az,1),当前时刻确定的第一旋转角度为α,以加速度的X轴为旋转轴线,根据第一旋转角度α对加速度数据进行旋转变换,得到旋转变换的加速度数据(ax,1,ay,1cosα-az,1sinα,ay,1sinα+az,1cosα),具体的旋转变换方式如下:
[0106]
[0107] 当前时刻确定的第一旋转角度为β,在得到旋转修正的加速度数据(ax,1,ay,1cosα+az,1sinα,ay,1(-sinα)+az,1cosα)后,以加速度的Y轴为旋转轴线,根据第一旋转角度β对所述旋转变换后的加速度数据进行旋转修正,得到旋转修正的加速度数据,具体的旋转变换方式如下:
[0108]
[0109] 第二种可行方式为:
[0110] 当前时刻的飞行速度不在预设范围内,根据预先设定的旋转角度修正量确定旋转角度,根据所述旋转角度对所述加速度数据进行旋转修正,以得到修正后的加速度数据。其中,每一次对加速度数据进行旋转修正时,旋转角度是根据预先设定的旋转角度修正量来确定的。所述当前时刻飞行器在水平方向的飞行速度包括当前时刻飞行器在机体坐标系下X轴方向的飞行速度和X轴方向的飞行速度。
[0111] 进一步地,根据预先设定的旋转角度修正量确定当前时刻的第一旋转角度,根据预先设定的旋转角度修正量确定当前时刻的第二旋转角度;根据所述第一旋转角度和第二旋转角度对所述加速度数据进行旋转修正以得到修正后的加速度数据。
[0112] 下面将详细介绍根据预先设定的旋转角度修正量确定当前时刻的第一旋转角度,根据预设设定的旋转修正确定当前时刻的第二旋转角度的过程:
[0113] 根据预先设定的旋转角度修正量和当前时刻的前一时刻的第一旋转角度确定当前时刻的第一旋转角度;根据预先设定的旋转角度修正量和当前时刻的前一时刻的第二旋转角度确定当前时刻的第二旋转角度。例如,预先设定的旋转角度修正量为αerr,在k=0时刻时,获取当前时刻的X轴方向的飞行速度Vx0、Y轴方向的飞行速度Vy0和加速度计输出的加速度数据,当前时刻的飞行速度Vx0、Vy0不在预设范围内时,第一旋转角度为αx0=αerr,第二旋转角度为αy0=αerr,根据第一旋转角度αx0和第二旋转角度αy0对加速度数据进行旋转变换,得到修正后的加速度数据,根据修正后的加速度数据对飞行速度进行控制以使k=1时刻的飞行速度小于当前时刻的飞行速度;
[0114] 在k=1时刻时,获取当前时刻的X轴方向的飞行速度Vx1、Y轴方向的飞行速度Vy1和加速度计输出的加速度数据,当前时刻的飞行速度Vx1、Vy1不在预设范围内时,第一旋转角度为预先设定的旋转角度修正量和当前时刻的第一旋转角度修正量之和,即αx1=αx0+αerr,第二旋转角度为k=0时刻的旋转角度和当前时刻的第二旋转角度修正量之和,即αy1=αy0+αerr,根据第一旋转角度αx1和第二旋转角度αy1对加速度数据进行旋转变换,得到修正后的加速度数据,根据修正后的加速度数据对飞行速度进行控制以使k=1时刻的飞行速度小于当前时刻的飞行速度;
[0115] 在k=2时刻时,获取当前时刻的X轴方向的飞行速度Vx2、Y轴方向的飞行速度Vy2和加速度计输出的加速度数据,当前时刻的飞行速度Vx2、Vy2不在预设范围内时,第一旋转角度为k=1时刻的旋转角度和当前时刻的第一旋转角度修正量之和,即αx2=αx1+αerr,第二旋转角度为k=1时刻的旋转角度和当前时刻的第二旋转角度修正量之和,即αy2=αy1+αerr,根据第一旋转角度αx2和第二旋转角度αy2对加速度数据进行旋转变换,得到修正后的加速度数据,根据修正后的加速度数据对飞行速度进行控制以使k=3时刻的飞行速度小于当前时刻的飞行速度;
[0116] 以此类推,直到下一时刻的飞行速度在预设范围内,即直到下一时刻的飞行速度小于预设的速度阈值。
[0117] 进一步地,根据所述第一旋转角度和第二旋转角度对所述加速度数据进行旋转修正,以得到修正后的加速度数据。其中,具体的实现方式请参考前述相关部分,在此不再赘述。
[0118] S604、根据所述修正后的加速度数据对所述飞行器在水平方向的飞行速度进行控制,以使得下一时刻所述飞行器在水平方向的飞行速度小于当前时刻所述飞行器在水平方向的飞行速度。
[0119] 在本实施例中,步骤S604的执行主体和执行原理与图2示出的实施例中的步骤S204一致,具体说明可参照本发明上述实施例中对步骤S204的说明,这里不再进行赘述。
[0120] 本实施例公开的航向修正方法,通过基于当前时刻的飞行速度对飞行器的加速度进行修正,并在得到修正后的加速度数据后,根据该修正后的加速度数据对该飞行器在水平方向的飞行速度进行控制,使得下一时刻该飞行器在水平方向的飞行速度小于当前时刻飞行器在水平方向的飞行速度。从而实现使飞行器在航向运动过程中的航向得到优化,有效降低飞行器在调转航向时出现的
偏航目的,进一步提高飞行器在行业应用中的灵活性和安全性。
[0121] 进一步的,基于上述本发明实施例公开的航向修正方法,在航向调整过程中,重复执行上述航向修正的过程,直至飞行器的水平方向的速度处于预设范围内,能够使飞行器在航向运动过程中的航向不断的得到优化,直至处于理想状态。
[0122] 本发明实施例提供一种航向修正设备。图7为本发明实施例提供的航向修正设备的结构图。如图7所示,该航向修正设备700包括:速度传感器701、加速度计702和处理器703。
[0123] 该速度传感器701,用于在飞行器进行航向运动过程中,获取当前时刻所述飞行器在水平方向的飞行速度,并发送给所述处理器703。
[0124] 该加速度计702,用于在飞行器进行航向运动过程中,获取所述飞行器的加速度数据,并发送给所述处理器703。
[0125] 处理器703,用于根据所述当前时刻的飞行速度对所述加速度数据进行修正,以得到修正后的加速度数据;以及根据所述修正后的加速度数据对所述飞行器在水平方向的飞行速度进行控制,以使得下一时刻所述飞行器在水平方向的飞行速度小于当前时刻所述飞行器在水平方向的飞行速度。
[0126] 在本实施例中,若该航向修正设备用于无人飞行器,结合图7,如图8所示,还包括:通讯接口704。该通讯接口704,用于接收控制终端发送的航向控制指令;
[0127] 相应地,该处理器703,用于根据所述航向控制指令控制所述飞行器进行航向运动。
[0128] 在具体应用实例中,该控制终端可以是遥控器、智能手机、平板电脑、地面控制站、膝上型电脑、手表、手环等及其组合,同时还可以在地面控制无人飞行器。
[0129] 在具体应用实例中,处理器根据所述当前时刻的飞行速度对所述加速度数据进行修正,以得到修正后的加速度数据时,具体用于:
[0130] 若所述当前时刻的飞行速度不在预设范围内时,对所述加速度数据进行修正以得到修正后的加速度数据。
[0131] 本发明实施例提供的航向修正设备的具体原理和实现方式均与图2所示实施例类似,此处不再赘述。
[0132] 本实施例公开的航向修正设备,通过在飞行器进行航向运动的过程中,获取当前时刻飞行器在水平方向的飞行速度以及飞行器的加速度数据,并根据该当前时刻的飞行速度对飞行器的加速度进行修正,以得到修正后的加速度数据,并根据该修正后的加速度数据对该飞行器在水平方向的飞行速度进行控制,以使得下一时刻该飞行器在水平方向的飞行速度小于当前时刻飞行器在水平方向的飞行速度。通过上述航向修正过程,在飞行器进行航向运动时,可以有效地减小飞行器在水平方向上的速度,即减小飞行器绕某一位置点环绕飞行的半径,使飞行器在进行航向运动的过程中保持原地不动,提升无人飞行器保持原地不动只调转航向的性能从而提高飞行器在行业应用中的灵活性和安全性。
[0133] 本发明实施例提供一种航向修正设备,在图7和图8所示实施例提供的技术方案的基础上,速度传感器,701在飞行器进行航向运动过程中,获取当前时刻所述飞行器在水平方向的飞行速度时,具体获取所述飞行器在机体坐标系下的X轴方向的速度、Y轴方向的速度。
[0134] 相应地,处理器703在若所述当前时刻的飞行速度不在预设范围内时,对所述加速度数据进行修正,以得到修正后的加速度数据时,具体为:若当前时刻的所述飞行器在机体坐标系下的X轴方向的速度、Y轴方向的速度不在预设范围内时,对所述加速度数据进行修正,以得到修正后的加速度数据。
[0135] 基于本实施例公开的速度传感器701和处理器703,可选的,处理器在若所述当前时刻的飞行速度不在预设范围内时,对所述加速度数据进行修正以得到修正后的加速度数据时:
[0136] 该处理器703具体用于,若所述当前时刻的飞行速度不在预设范围内时,确定旋转角度,根据所述修正量对所述加速度数据进行旋转修正,以得到修正后的加速度数据。
[0137] 进一步的,处理器703在所述确定旋转角度,根据所述修正量对加速度数据进行修正,以得到修正后的加速度数据时,具体用于:
[0138] 根据所述当前时刻飞行器在水平方向的飞行速度,确定当前时刻的旋转角度,根据所述旋转角度对加速度数据进行旋转修正,以得到修正后的加速度数据。
[0139] 进一步的,处理器703在所述根据所述当前时刻所述飞行器在水平方向的飞行速度,确定当前时刻的旋转角度,根据所述旋转角度对所述加速度数据进行旋转修正,以得到修正后的加速度数据时,具体用于:
[0140] 根据机体坐标系下的X轴方向的速度确定当前时刻的第一旋转角度,根据机体坐标系下的Y轴方向的速度确定当前时刻的第二旋转角度;
[0141] 根据所述第一旋转角度和第二旋转角度对所述加速度数据进行旋转修正以得到修正后的加速度数据。
[0142] 进一步的,处理器703在所述根据机体坐标系下的X轴方向的速度确定第一旋转角度,根据机体坐标系下的Y轴方向的速度确定第二旋转角度时,具体用于:
[0143] 根据机体坐标系下的X轴方向的速度确定当前时刻的第一旋转角度修正量,根据第一旋转角度修正量和当前时刻的前一时刻的第一旋转角度确定当前时刻的第一旋转角度;
[0144] 根据机体坐标系下的Y轴方向的速度确定当前时刻的第二旋转角度修正量,根据第二旋转角度修正量和当前时刻的前一时刻的第二旋转角度确定当前时刻的第二旋转角度。
[0145] 在基于本实施例上述确定第一旋转角度和第二旋转角度后,该处理器703具体用于根据所述第一旋转角度和第二旋转角度对所述加速度数据进行旋转修正以得到修正后的加速度数据。
[0146] 可选的,在处理器703根据所述第一旋转角度和第二旋转角度得到修正后的加速度数据的方式为:
[0147] 可选的,先以加速度计的Y轴为旋转轴线,将所述加速度数据按照第一旋转角度进行旋转变换以得到旋转变换后的加速度数据;再以加速度计的X轴为旋转轴线,将所述旋转变换后的加速度数据按照第二旋转角度进行旋转变换以得到所述修正后的加速度数据。
[0148] 可选的,先以加速度计的X轴为旋转轴线,将所述加速度数据按照第二旋转角度进行旋转变换以得到旋转变换后的加速度数据;再以加速度计的Y轴为旋转轴线,将所述旋转变换后的加速度数据按照第一旋转角度进行旋转变换以得到所述修正后的加速度数据。
[0149] 本发明实施例提供的航向修正设备的具体原理和实现方式均与图4-图6所示实施例中对所涉及到的速度传感器、处理器和加速度计类似,此处不再赘述。
[0150] 本实施例公开的航向修正设备,通过在飞行器进行航向运动的过程中,获取当前时刻飞行器在水平方向的飞行速度以及飞行器的加速度数据,并根据该当前时刻的飞行速度对飞行器的加速度进行修正,以得到修正后的加速度数据,并根据该修正后的加速度数据对该飞行器在水平方向的飞行速度进行控制,以使得下一时刻该飞行器在水平方向的飞行速度小于当前时刻飞行器在水平方向的飞行速度。通过上述航向修正过程,在飞行器进行航向运动时,可以有效地减小飞行器在水平方向上的速度,即减小飞行器绕某一位置点环绕飞行的半径,使飞行器在进行航向运动的过程中保持原地不动,提升无人飞行器保持原地不动只调转航向的性能从而提高飞行器在行业应用中的灵活性和安全性。
[0151] 进一步的,在飞行器在进行航向运动的过程中,该速度传感器701、该加速度计702和处理器703可以重复上述步骤,直至所述飞行器在水平方向的速度在预设范围内。确保飞行器在航向运动过程中的航向不断的得到优化,直至处理理想状态。
[0152] 本发明实施例提供一种飞行器。该飞行器可以具体为无人飞行器。图9为本发明实施例提供的无人飞行器的结构示意图。如图9所示,该无人飞行器包括:机身901,动力系统902和航向修正设备903。该动力系统902安装于所述机身901,用于提供飞行动力。该航向修正设备903为上述本发明实施例中公开的任意一种航向修正设备,原理和实现方式均与上述实施例类似,此处不再赘述。
[0153] 具体地,动力系统包括螺旋桨、
电机、电调中的一种或多种,无人飞行器还可以包括
云台904以及成像设备905,成像设备905通过云台904搭载于无人飞行器的主体上。成像设备905用于在无人飞行器的飞行过程中进行图像或视频拍摄,包括但不限于多
光谱成像仪、高光谱成像仪、可见光相机及红外相机等,云台904为多轴传动及增稳系统,云台电机通过调整转动轴的转动角度来对成像设备905的拍摄角度进行补偿,并通过设置适当的缓冲机构来防止或减小成像设备905的抖动。其中,无人机接收控制终端1000的控制指令,例如安装误差检测指令,并根据所述指令控制无人机执行相应的动作。
[0154] 在本发明所提供的几个实施例中,应该理解到,所揭露的设备和方法,可以通过其它的方式实现。例如,以上所描述的设备实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,设备或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
[0155] 所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
[0156] 另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用
硬件的形式实现,也可以采用硬件加
软件功能单元的形式实现。
[0157] 上述以软件功能单元的形式实现的集成的单元,可以存储在一个计算机可读取存储介质中。上述软件功能单元存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,
服务器,或者网络设备等)或处理器(processor)执行本发明各个实施例所述方法的部分步骤。而前述的存储介质包括:U盘、移动
硬盘、只读
存储器(Read-Only Memory,ROM)、
随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
[0158] 本领域技术人员可以清楚地了解到,为描述的方便和简洁,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将装置的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。上述描述的装置的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
[0159] 最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行
修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。