发明内容
本发明的主要目的在于提供一种飞行器防侧翻方法及装置,旨在有效的防止飞行器发生侧翻,进而使得飞行器安全起飞。
为实现上述目的,本发明提供一种飞行器防侧翻方法,该方法包括:
检测飞行器的飞行姿态;
根据所述飞行器的飞行姿态判断所述飞行器是否存在侧翻趋势;
若所述飞行器存在侧翻趋势,则对所述飞行器的马达的转速进行调整,以解除所述飞行器的侧翻趋势。
优选地,所述检测飞行器的飞行姿态包括:
检测所述飞行器的飞行高度及检测所述飞行器机身与水平面之间的角度信息。
优选地,所述根据所述飞行器的飞行姿态判断所述飞行器是否存在侧翻趋势包括:
在所述检测的飞行器的飞行高度小于或等于预设高度阀值时,判断所述获取的角度信息是否大于或等于最大安全角度阀值;
若所述获取的角度信息大于或等于最大安全角度阀值,则确定所述飞行器存在侧翻趋势。
优选地,所述若所述飞行器存在侧翻趋势,则对所述飞行器的马达的转速进行调整,以解除所述飞行器的侧翻趋势的步骤包括:
若所述飞行器存在侧翻趋势,则加大所述飞行器上侧翻面对应马达的转速,及保持所述飞行器上非侧翻面对应马达的转速,以解除所述飞行器的侧翻趋势。
优选地,所述根据所述飞行器的飞行姿态判断所述飞行器是否存在侧翻趋势包括:
在所述检测的飞行器的飞行高度大于所述预设高度阀值时,判断继续检测的预设次数的飞行器的飞行高度是否呈递减趋势;
若继续检测的预设次数的飞行器的飞行高度呈递减趋势,则确定所述飞行器存在侧翻趋势。
优选地,所述若所述飞行器存在侧翻趋势,则对所述飞行器的马达的转速进行调整,以解除所述飞行器的侧翻趋势的步骤包括:
若所述飞行器存在侧翻趋势,则根据所述预设次数的飞行器的飞行高度的变化速度,加大所述飞行器上马达的转速,以解除所述飞行器的侧翻趋势。
此外,为实现上述目的,本发明还提供一种飞行器防侧翻装置,该装置包括:
检测模块,用于检测飞行器的飞行姿态;
判断模块,用于根据所述飞行器的飞行姿态判断所述飞行器是否存在侧翻趋势;
控制模块,用于在所述飞行器存在侧翻趋势时,对所述飞行器的马达的转速进行调整,以解除所述飞行器的侧翻趋势。
优选地,所述检测模块包括检测单元,用于检测所述飞行器的飞行高度及检测所述飞行器机身与水平面之间的角度信息。
优选地,所述判断模块包括:
第一判断单元,用于在所述检测的飞行器的飞行高度小于或等于预设高度阀值时,判断所述获取的角度信息是否大于或等于最大安全角度阀值;
第一确定单元,用于在所述获取的角度信息大于或等于最大安全角度阀值时,确定所述飞行器存在侧翻趋势。
优选地,所述控制模块包括第一控制单元,用于在所述飞行器存在侧翻趋势时,加大所述飞行器上侧翻面对应马达的转速,及保持所述飞行器上非侧翻面对应马达的转速。
优选地,所述判断模块包括:
第二判断单元,用于在所述检测的飞行器的飞行高度大于所述预设高度阀值时,判断继续检测的预设次数的飞行器的飞行高度是否呈递减趋势;
第二确定单元,用于在继续检测的预设次数的飞行器的飞行高度呈递减趋势时,确定所述飞行器存在侧翻趋势。
优选地,所述控制模块还包括第二控制单元,用于在所述飞行器存在侧翻趋势时,根据所述预设次数的飞行器的飞行高度的变化速度,加大所述飞行器上马达的转速,以解除所述飞行器的侧翻趋势。
本发明的飞行器防侧翻方法及装置,通过检测飞行器的飞行姿态;根据所述飞行器的飞行姿态判断所述飞行器是否存在侧翻趋势;若所述飞行器存在侧翻趋势,则对所述飞行器的马达的转速进行调整,以解除所述飞行器的侧翻趋势;可有效的防止飞行器发生侧翻,进而使得飞行器安全起飞。
具体实施方式
应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
本发明提供一种飞行器防侧翻方法。
参照图1,图1为本发明飞行器防侧翻方法的优选实施例流程示意图,该方法包括:
S10、检测飞行器的飞行姿态。
在飞行器起飞或飞行过程中,实时检测飞行器的飞行姿态。在一实施例中,检测该飞行器的飞行高度及检测该飞行器机身与水平面之间的角度信息,还可以检测该飞行器的各个马达的转速等。该飞行器可以为四轴飞行器或六轴飞行器,四轴飞行器具有四个螺旋桨,六轴飞行器具有六个螺旋桨,一个马达连接一个螺旋桨,马达带动与它连接的螺旋桨旋转,从而驱动飞行器。
可按照预设第一采样频率检测飞行器的飞行高度,如该第一预设采样频率为500次/秒,不同飞行器的第一采样频率可不同;当飞行器的软硬件配置比较高时,预设第一采样频率高一点。可通过设置在飞行器内的高度计采集飞行器的飞行高度。较佳的,该高度计为气压高度计,将该气压高度计安置在飞机中,利用气压与高度的关系,通过观测气压测量飞机飞行时的海拔高度(又称绝对高度)。
可按照预设第二采样频率检测飞行器机身与水平面之间的角度信息,该第二采样频率可与该第一采样频率相同,也可与该第一采样频率不相同,不同飞行器的第二采样频率可不同;当飞行器的软硬件配置比较高时,预设第二采样频率高一点。可通过设置在飞行器内的角度传感器采集飞行器机身与水平面之间的角度信息。该角度传感器可以为陀螺仪,较佳的,该陀螺仪为三轴陀螺仪,该三轴陀螺仪有三个轴,即X轴、Y轴和Z轴,通过X轴、Y轴和Z轴组成三维空间的坐标系;通过该三轴陀螺仪可同时测量该飞行器在水平面4个方向的角度信息。
可按照预设第三采样频率检测该飞行器的各个马达的转速,该第三采样频率可与该第一采样频率相同,也可与该第一采样频率不相同。当该飞行器为四轴飞行器时,该飞行器包括四个马达,该四个马达分别控制左上螺旋桨、左下螺旋桨、右上螺旋桨、右下螺旋桨的旋转速度。可通过转速传感器采集飞行器的各个马达的转速,较佳的,该转速传感器为霍尔转速传感器。
S20、根据该飞行器的飞行姿态判断该飞行器是否存在侧翻趋势,若该飞行器存在侧翻趋势,则执行步骤S30;若该飞行器不存在侧翻趋势,则执行步骤S40。
在该步骤中,判断飞行器是否存在侧翻趋势,在一实施例中,如图2所示,该步骤S20包括:
S21、在该检测的飞行器的飞行高度小于或等于预设高度阀值时,判断该获取的角度信息是否大于或等于最大安全角度阀值,若该获取的角度信息大于或等于最大安全角度阀值,则执行步骤S22,否则执行步骤S23。
该预设高度阀值可根据实际需要设置,该最大安全角度阀值根据实际需要设置,如可设置为2°,即当在飞行器上获取的角度信息大于或等于2°时,则可以认为飞行器存在侧翻趋势,当在飞行器上获取的角度信息小于2°时,则可以认为飞行器不存在侧翻趋势。
在飞行器的飞行器高度小于或等于预设高度阀值时,通过比较获取的角度信息与最大安全角度阀值之间的大小关系确定该飞行器是否存在侧翻趋势。
S22、确定该飞行器存在侧翻趋势。
在该步骤中,确定飞行器存在侧翻趋势,该侧翻趋势包括向左侧翻趋势、向右侧翻趋势、向前侧翻趋势、向后侧翻趋势,如果获取的角度信息为飞行器在水平面坐标上的X轴的正方向上的角度信息,且该获取的角度信息大于或等于最大安全角度阀值时,则可以确定该飞行器存在向右侧翻趋势;如果获取的角度信息为飞行器在水平面坐标上的X轴的负方向上的角度信息,且该获取的角度信息大于或等于最大安全角度阀值时,则可以确定该飞行器存在向左侧翻趋势;如果获取的角度信息为飞行器在水平面坐标上的Y轴的正方向上的角度信息,且该获取的角度信息大于或等于最大安全角度阀值时,则可以确定该飞行器存在向前侧翻趋势;如果获取的角度信息为飞行器在水平面坐标上的Y轴的负方向上的角度信息,且该获取的角度信息大于或等于最大安全角度阀值时,则可以确定该飞行器存在向后侧翻趋势。
S23、确定该飞行器不存在侧翻趋势。
在另一实施例中,如图3所示,该步骤S20包括:
S24、在该检测的飞行器的飞行高度大于该预设高度阀值时,判断继续检测的预设次数的飞行器的飞行高度是否呈递减趋势;若继续检测的预设次数的飞行器的飞行高度呈递减趋势,则执行步骤S25,否则执行步骤S26。
该预设高度阀值可根据实际需要设置,该预设次数也可以根据实际需要设置,如设置为十次。
在该检测的飞行器的飞行高度大于该预设高度阀值时,为该飞行器在起飞过程中,在检测到的飞行器的飞行高度第一次大于该预设高度阀值时。
在该检测的飞行器的飞行高度大于该预设高度阀值时,通过判断继续检测的预设次数的飞行器的飞行高度的变化趋势确定该飞行器是否存在侧翻趋势;当继续检测的预设次数的飞行器的飞行高度的变化趋势为递增趋势时,则认为飞行器不存在侧翻趋势;当继续检测的预设次数的飞行器的飞行高度的变化趋势为递减趋势时,则认为飞行器存在侧翻趋势。
在该检测的飞行器的飞行高度大于该预设高度阀值时,获取的角度信息不作为飞行器是否存在侧翻趋势的判断依据,飞行器在飞到预设高度阀值之后,可能在做大幅度的姿态变换动作;即在检测的飞行器的飞行高度大于该预设高度阀值时,即使获取的角度信息大于或等于最大安全角度阀值,也不认为该飞行器存在侧翻趋势。
当该预设次数为十次,这十次检测的飞行器的飞行高度依次为h1、h2、h3、h4、h5、h6、h7、h8、h9、h10,如果h1>h2>h3>h4>h5>h6>h7>h8>h9>h10,可看出当前采集的飞行器的飞行高度小于前一采样时刻采集的飞行器的飞行高度,说明飞行器越飞越低,存在侧翻趋势。
S25、确定该飞行器存在侧翻趋势。
S26、确定该飞行器不存在侧翻趋势。
S30、对该飞行器的马达的转速进行调整,以解除该飞行器的侧翻趋势。
在该步骤中,对飞行器的马达的转速进行调整。
在一实施例中,在飞行器的飞行高度小于或等于预设高度阀值时,在该飞行器存在侧翻趋势时,对该飞行器的马达的转速进行调整的步骤包括:加大该飞行器上侧翻面对应马达的转速,及保持该飞行器上非侧翻面对应马达的转速,以解除该飞行器的侧翻趋势。在加大该飞行器上侧翻面对应的马达的转速时,可将该侧翻面对应的马达的转速加大为原来转速的预设倍数,如1.2倍,如当侧翻面对应的马达为控制左上的螺旋桨和控制左下的螺旋桨(飞行器存在向左侧翻趋势)的两个马达,则将这两个马达的转速都加大,加大为原来为的1.2倍;同时对于控制右上的螺旋桨和控制右下的螺旋桨的两个马达的转速不进行调整,这两个马达保持当前的转速运行。在加大该飞行器上侧翻面对应的马达的转速时,可将该侧翻面对应的马达的PID(proportion-integration-differentiation,比例-积分-微分)控制环节中的系数D的值增大,使得对马达在微分环节的调节效果更加明显,马达的矫正速度也会加快。
在另一实施例中,在飞行器的飞行高度大于预设高度阀值时,在该飞行器存在侧翻趋势,则根据该预设次数的飞行器的飞行高度的变化速度,加大该飞行器上马达的转速,以解除该飞行器的侧翻趋势。其中根据该预设次数的飞行器的飞行高度的变化速度,加大该飞行器上马达的转速的步骤为:根据该预设次数的飞行器的飞行高度的变化速度,确定一个比例系数,再根据该比例系数和飞行器上各马达原来控制信号占空比,得到各马达的新的控制信息占空比,根据该新控制信号占空比调整马达的转速,如通过以下公式计算各马达的新的控制信息占空比,Duty=H*C*duty,其中Duty表示新的控制信号的占空比,H表示比例系数,C是常数,duty是马达的原来控制信号占空比,该C可由技术人员自定,技术人员根据飞行器多次侧翻发生时的高度差估算出来。该比例系数H可通过以下公式计算得到,H=(h1+h2+h3+……+hn/2)*2/n-(hn/2+1+hn/2+2+hn/2+3+……+hn)*2/n,其中n为偶数。
S40、控制该飞行器的马达按照当前转速运行。
在该步骤中,不需要对飞行器的马达转速进行调整,各马达按照当前转速运行即可。
采用本发明的上述实施例,通过检测飞行器的飞行姿态;根据所述飞行器的飞行姿态判断所述飞行器是否存在侧翻趋势;若所述飞行器存在侧翻趋势,则对所述飞行器的马达的转速进行调整,以解除所述飞行器的侧翻趋势;可有效的防止飞行器发生侧翻,进而使得飞行器安全起飞。
本发明还提供一种飞行器防侧翻装置。
参照图4,图4为本发明飞行器防侧翻装置的优选实施例结构示意图,该装置设置于飞行器中,该装置包括检测模块10,与该检测模块10连接的判断模块20,与该判断模块20连接的控制模块30,其中:
该检测模块10,用于检测飞行器的飞行姿态;
该判断模块20,用于根据该飞行器的飞行姿态判断该飞行器是否存在侧翻趋势;
该控制模块30,用于在该飞行器存在侧翻趋势时,对该飞行器的马达的转速进行调整,以解除该飞行器的侧翻趋势。
在飞行器起飞或飞行过程中,该检测模块10实时检测飞行器的飞行姿态。在一实施例中,该检测模块10检测该飞行器的飞行高度及检测该飞行器机身与水平面之间的角度信息,还可以检测该飞行器的各个马达的转速等。该飞行器可以为四轴飞行器或六轴飞行器,四轴飞行器具有四个螺旋桨,六轴飞行器具有六个螺旋桨,一个马达连接一个螺旋桨,马达带动与它连接的螺旋桨旋转,从而驱动飞行器。
该检测模块10可按照预设第一采样频率检测飞行器的飞行高度,如该第一预设采样频率为500次/秒,不同飞行器的第一采样频率可不同;当飞行器的软硬件配置比较高时,预设第一采样频率高一点。可通过设置在飞行器内的高度计采集飞行器的飞行高度。较佳的,该高度计为气压高度计,将该气压高度计安置在飞机中,利用气压与高度的关系,通过观测气压测量飞机飞行时的海拔高度(又称绝对高度)。
该检测模块10可按照预设第二采样频率检测飞行器机身与水平面之间的角度信息,该第二采样频率可与该第一采样频率相同,也可与该第一采样频率不相同,不同飞行器的第二采样频率可不同;当飞行器的软硬件配置比较高时,预设第二采样频率高一点。可通过设置在飞行器内的角度传感器采集飞行器机身与水平面之间的角度信息。该角度传感器可以为陀螺仪,较佳的,该陀螺仪为三轴陀螺仪,该三轴陀螺仪有三个轴,即X轴、Y轴和Z轴,通过X轴、Y轴和Z轴组成三维空间的坐标系;通过该三轴陀螺仪可同时测量该飞行器在水平面4个方向的角度信息。
该检测模块10可按照预设第三采样频率检测该飞行器的各个马达的转速,该第三采样频率可与该第一采样频率相同,也可与该第一采样频率不相同。当该飞行器为四轴飞行器时,该飞行器包括四个马达,该四个马达分别控制左上螺旋桨、左下螺旋桨、右上螺旋桨、右下螺旋桨的旋转速度。可通过转速传感器采集飞行器的各个马达的转速,较佳的,该转速传感器为霍尔转速传感器。
该判断模块20判断飞行器是否存在侧翻趋势,在一实施例中,如图4所示,该判断模块20包括第一判断单元21,与该第一判断单元21连接的第一确定单元22,其中:
该第一判断单元21,用于在该检测的飞行器的飞行高度小于或等于预设高度阀值时,判断该获取的角度信息是否大于或等于最大安全角度阀值;
该第一确定单元22,用于在该获取的角度信息大于或等于最大安全角度阀值时,确定该飞行器存在侧翻趋势;及用于在该获取的角度信息小于最大安全角度阀值时,确定该飞行器不存在侧翻趋势。
该预设高度阀值可根据实际需要设置,该最大安全角度阀值根据实际需要设置,如可设置为2°,即当在飞行器上获取的角度信息大于或等于2°时,则可以认为飞行器存在侧翻趋势,当在飞行器上获取的角度信息小于2°时,则可以认为飞行器不存在侧翻趋势。
该第一判断单元21在飞行器的飞行器高度小于或等于预设高度阀值时,通过比较获取的角度信息与最大安全角度阀值之间的大小关系确定该飞行器是否存在侧翻趋势。
该第一确定单元22在该获取的角度信息大于或等于最大安全角度阀值时,确定飞行器存在侧翻趋势,该侧翻趋势包括向左侧翻趋势、向右侧翻趋势、向前侧翻趋势、向后侧翻趋势,如果获取的角度信息为飞行器在水平面坐标上的X轴的正方向上的角度信息,且该获取的角度信息大于或等于最大安全角度阀值时,则可以确定该飞行器存在向右侧翻趋势;如果获取的角度信息为飞行器在水平面坐标上的X轴的负方向上的角度信息,且该获取的角度信息大于或等于最大安全角度阀值时,则可以确定该飞行器存在向左侧翻趋势;如果获取的角度信息为飞行器在水平面坐标上的Y轴的正方向上的角度信息,且该获取的角度信息大于或等于最大安全角度阀值时,则可以确定该飞行器存在向前侧翻趋势;如果获取的角度信息为飞行器在水平面坐标上的Y轴的负方向上的角度信息,且该获取的角度信息大于或等于最大安全角度阀值时,则可以确定该飞行器存在向后侧翻趋势。
该判断模块20判断飞行器是否存在侧翻趋势,在另一实施例中,如图4所示,该判断模块20包括第二判断单元23,与该第二判断单元23连接的第二确定单元24,其中:
该第二判断单元23,用于在该检测的飞行器的飞行高度大于该预设高度阀值时,判断继续检测的预设次数的飞行器的飞行高度是否呈递减趋势;
该第二确定单元24,用于在继续检测的预设次数的飞行器的飞行高度呈递减趋势时,确定该飞行器存在侧翻趋势;及用于在继续检测的预设次数的飞行器的飞行高度不是呈递减趋势时,确定该飞行器不存在侧翻趋势。
该预设高度阀值可根据实际需要设置,该预设次数也可以根据实际需要设置,如设置为十次。
在该检测的飞行器的飞行高度大于该预设高度阀值时,为该飞行器在起飞过程中,在检测到的飞行器的飞行高度第一次大于该预设高度阀值时。
该第二判断单元23在该检测的飞行器的飞行高度大于该预设高度阀值时,通过判断继续检测的预设次数的飞行器的飞行高度的变化趋势确定该飞行器是否存在侧翻趋势;当继续检测的预设次数的飞行器的飞行高度的变化趋势为递增趋势时,则认为飞行器不存在侧翻趋势;当继续检测的预设次数的飞行器的飞行高度的变化趋势为递减趋势时,则认为飞行器存在侧翻趋势。
在该检测的飞行器的飞行高度大于该预设高度阀值时,获取的角度信息不作为飞行器是否存在侧翻趋势的判断依据,飞行器在飞到预设高度阀值之后,可能在做大幅度的姿态变换动作;即在检测的飞行器的飞行高度大于该预设高度阀值时,即使获取的角度信息大于或等于最大安全角度阀值,也不认为该飞行器存在侧翻趋势。
当该预设次数为十次,这十次检测的飞行器的飞行高度依次为h1、h2、h3、h4、h5、h6、h7、h8、h9、h10,如果h1>h2>h3>h4>h5>h6>h7>h8>h9>h10,可看出当前采集的飞行器的飞行高度小于前一采样时刻采集的飞行器的飞行高度,说明飞行器越飞越低,存在侧翻趋势。
在一实施例中,在该判断模块20的判断结果为,飞行器的飞行高度小于或等于预设高度阀值时,该飞行器存在侧翻趋势时,该控制模块30包括第一控制单元,用于在该飞行器存在侧翻趋势时,加大该飞行器上侧翻面对应马达的转速,及保持该飞行器上非侧翻面对应马达的转速。
该第一控制单元在加大该飞行器上侧翻面对应的马达的转速时,可将该侧翻面对应的马达的转速加大为原来转速的预设倍数,如1.2倍,如当侧翻面对应的马达为控制左上的螺旋桨和控制左下的螺旋桨(飞行器存在向左侧翻趋势)的两个马达,则将这两个马达的转速都加大,加大为原来为的1.2倍;同时对于控制右上的螺旋桨和控制右下的螺旋桨的两个马达的转速不进行调整,这两个马达保持当前的转速运行。该第一控制模块30在加大该飞行器上侧翻面对应的马达的转速时,可将该侧翻面对应的马达的PID(proportion-integration-differentiation,比例-积分-微分)控制环节中的系数D的值增大,使得对马达在微分环节的调节效果更加明显,马达的矫正速度也会加快。
在另一实施例中,在该判断模块20的判断结果为,飞行器的飞行高度大于预设高度阀值时,该飞行器存在侧翻趋势时,该控制模块30包括第二控制单元,用于在该飞行器存在侧翻趋势时,根据该预设次数的飞行器的飞行高度的变化速度,加大该飞行器上马达的转速,以解除该飞行器的侧翻趋势。
该第二控制单元根据该预设次数的飞行器的飞行高度的变化速度,加大该飞行器上马达的转速具体为:根据该预设次数的飞行器的飞行高度的变化速度,确定一个比例系数,再根据该比例系数和飞行器上各马达原来控制信号占空比,得到各马达的新的控制信息占空比,根据该新控制信号占空比调整马达的转速,如通过以下公式计算各马达的新的控制信息占空比,Duty=H*C*duty,其中Duty表示新的控制信号的占空比,H表示比例系数,C是常数,duty是马达的原来控制信号占空比,该C可由技术人员自定,技术人员根据飞行器多次侧翻发生时的高度差估算出来。该比例系数H可通过以下公式计算得到,H=(h1+h2+h3+……+hn/2)*2/n-(hn/2+1+hn/2+2+hn/2+3+……+hn)*2/n,其中n为偶数。
以上仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。