CN105511484A - 控制无人机稳定飞行的方法及装置 - Google Patents
控制无人机稳定飞行的方法及装置 Download PDFInfo
- Publication number
- CN105511484A CN105511484A CN201510897158.8A CN201510897158A CN105511484A CN 105511484 A CN105511484 A CN 105511484A CN 201510897158 A CN201510897158 A CN 201510897158A CN 105511484 A CN105511484 A CN 105511484A
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- crab angle
- monitoring data
- magnetometer
- gps
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 40
- 230000001133 acceleration Effects 0.000 claims abstract description 105
- 238000012544 monitoring process Methods 0.000 claims abstract description 86
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 36
- 238000012806 monitoring device Methods 0.000 claims abstract description 36
- 238000004364 calculation method Methods 0.000 claims description 18
- 239000011159 matrix material Substances 0.000 claims description 15
- 238000013480 data collection Methods 0.000 claims description 4
- 230000005484 gravity Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000001143 conditioned effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000002860 competitive effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种控制无人机稳定飞行的方法,其方法包括:无人机飞行过程中,飞控系统收集无人机上所搭载的监测装置所返回的监测数据,所述监测装置至少包括:GPS、加速度传感器、陀螺仪和磁力计;根据所述监测装置返回的监测数据,至少对所述无人机的飞行航向和平稳性中的一项进行控制。本发明还公开了一种控制无人机稳定飞行的装置。本发明解决了无人机在飞行过程中,由于飞行环境等因素影响导致无人机偏航角产生误差进一步对无人机的偏航方向产生影响,以及无人机横滚角和俯仰角受到影响后发生偏差的情况下,致使无人机无法正常平稳飞行的问题。
Description
技术领域
本发明涉及无人机飞行控制领域,尤其涉及控制无人机稳定飞行的方法及装置。
背景技术
目前,无人机广泛应用于民用、商用及军事领域,在民用领域,越来越多的极限运动爱好者使用无人机进行摄录,在商用领域,除搭载摄像设备对各项体育赛事进行跟踪航拍以外,并已进入物流行业,可以将货物送往人力配送较难、较慢的偏远地区,因此,无人机有着广泛的应用范围及广阔的市场前景。
现有飞控系统中,为保证无人机平稳飞行,无人机飞行过程中需要通过磁力计获得的数据控制无人机的偏航方向,以及通过陀螺仪获得的数据控制飞行器横滚角和俯仰角使得无人机正常飞行,由于磁力计抗电磁干扰能力弱,容易受到强磁场的干扰从而导致获取的数据准确度差,从而造成飞控系统不能正确的控制无人机偏航方向,使得无人机存在坠机等风险,而陀螺仪为惯性器件,长期使用后陀螺仪获得的数据存在漂移的情况,使得无人机不能按照预设路径平稳飞行。
发明内容
本发明的主要目的在于提供一种控制无人机稳定飞行的方法及装置,旨在解决磁力计受到电磁干扰后返回的数据准确度差,导致飞控系统无法正确控制无人机偏航方向,以及陀螺仪发生漂移后无人机无法正常飞行的技术问题。
为实现上述目的,本发明提供一种控制无人机稳定飞行的方法,所述控制无人机稳定飞行的方法包括以下步骤:
无人机飞行过程中,飞控系统收集无人机上所搭载的监测装置所返回的监测数据,所述监测装置至少包括:GPS(GlobalPositioningSystem,全球定位系统)、加速度传感器、陀螺仪和磁力计;
根据所述监测装置返回的监测数据,至少对所述无人机的飞行航向和平稳性中的一项进行控制。
优选地,所述根据所述监测装置返回的监测数据,对所述无人机的飞行航向进行控制的步骤包括:
根据所述GPS和磁力计返回的监测数据判断磁力计是否失效;
当判断到磁力计已失效时,根据GPS返回的监测数据计算无人机偏航角,获得无人机的偏航角误差;
根据所述偏航角误差控制所述无人机的偏航方向。
优选地,所述根据所述GPS和磁力计返回的监测数据判断磁力计是否失效的步骤包括:
根据GPS返回的监测数据获得无人机偏航角A;
根据磁力计返回的监测数据获得无人机偏航角B;
计算获得偏航角A与偏航角B的差的绝对值,若所述绝对值大于预设阀值,则判断磁力计已失效,否则,磁力计正常。
优选地,所述当判断到磁力计已失效时,根据GPS返回的监测数据计算无人机偏航角,获得无人机的偏航角误差的步骤包括:
根据GPS返回的监测数据获得无人机沿大地坐标系x,y方向的速度;
根据所述无人机沿大地坐标系x,y方向的速度计算得到无人机偏航角;
根据所述无人机偏航角和上一时刻无人机偏航角获得无人机的偏航角误差。
优选地,根据所述监测装置返回的监测数据,对所述无人机的平稳性进行控制的步骤包括:
将所述加速度传感器返回的监测数据通过旋转矩阵获得无人机机体x、y和z轴三个方向上的加速度信息A;
根据所述GPS返回的监测数据获得无人机沿大地坐标系中x、y和z三个方向上的速度,并根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B;
对加速度信息A与加速度信息B进行向量叉乘获得计算结果;
根据所述计算结果对无人机的横滚角和俯仰角进行修正,对所述无人机的平稳性进行控制。
此外,为实现上述目的,本发明还提供一种控制无人机稳定飞行的装置,所述控制无人机稳定飞行的装置包括:
数据收集模块,用于在无人机飞行过程中,飞控系统收集无人机搭载的监测装置返回的监测数据,所述监测装置至少包括:GPS、加速度传感器、陀螺仪和磁力计;
飞行控制模块,用于根据所述监测装置返回的监测数据,至少对所述无人机的飞行航向和平稳性中的一项进行控制。
优选地,所述飞行控制模块包括:
判断单元,用于根据所述GPS和磁力计返回的监测数据判断磁力计是否失效;
误差获取单元,用于当判断到磁力计已失效时,根据GPS返回的监测数据计算无人机偏航角,获得无人机的偏航角误差;
方向控制单元,用于根据所述偏航角误差控制所述无人机的偏航方向。
优选地,所述判断单元包括:
GPS偏航角获取单元,用于根据GPS返回的监测数据获得无人机偏航角A;
磁力计偏航角获取单元,用于根据磁力计返回的监测数据获得无人机偏航角B;
计算判断单元,用于计算获得偏航角A与偏航角B的差的绝对值,若所述绝对值大于预设阀值,则判断磁力计已失效,否则,磁力计正常。
优选地,所述误差获取单元包括:
速度获取单元,用于根据GPS返回的监测数据获得无人机沿大地坐标系x,y方向的速度;
偏航角获取单元,用于根据所述无人机沿大地坐标系x,y方向的速度计算得到无人机偏航角;
偏航角误差获取单元,用于根据所述无人机偏航角和上一时刻无人机偏航角获得无人机的偏航角误差。
优选地,所述飞行控制模块还包括:
直接获取加速度单元,用于将加速度传感器返回的监测数据通过旋转矩阵获得无人机机体x、y和z轴三个方向上的加速度信息A;
计算获取加速度单元,用于根据所述GPS返回的监测数据获得无人机沿大地坐标系中x、y和z三个方向上的速度,并根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B;
计算单元,用于对加速度信息A与加速度信息B进行向量叉乘获得计算结果;
修正控制单元,用于根据所述计算结果对无人机的横滚角和俯仰角进行修正,对所述无人机的平稳性进行控制。
本发明实施例提出的一种控制无人机稳定飞行的方法及装置,通过使用GPS获取的数据,对磁力计状态进行判断,并在磁力计受到电磁干扰失效时,通过GPS获取的数据对无人机偏航方向进行控制,以及定时使用GPS获取的数据对无人机中搭载的陀螺仪进行修正,实现了无人机在受到电磁干扰时飞控系统仍能正确控制无人机偏航方向的功能,以及定时对陀螺仪进行修正,使得陀螺仪提供的数据准确可靠。
附图说明
图1为本发明控制无人机稳定飞行的方法第一实施例的流程示意图;
图2为本发明控制无人机稳定飞行的方法第二实施例的流程示意图;
图3为本发明控制无人机稳定飞行的方法第三实施例的流程示意图;
图4为本发明控制无人机稳定飞行的装置第一实施例的功能模块示意图;
图5为本发明控制无人机稳定飞行的装置第二实施例的功能模块示意图;
图6为本发明控制无人机稳定飞行的装置第三实施例的功能模块示意图;
本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
本发明实施例的主要解决方案是:无人机飞行过程中,飞控系统收集无人机上所搭载的监测装置所返回的监测数据,所述监测装置至少包括:GPS、加速度传感器、陀螺仪和磁力计;根据所述监测装置返回的监测数据,至少对所述无人机的飞行航向和平稳性中的一项进行控制。
现有技术中,在磁力计受到电磁干扰时,无法提供准确度较高的信息,从而造成飞控系统不能正确的控制无人机偏航方向,可能使得无人机存在坠机等风险,以及陀螺仪在长期使用后其获得的数据存在漂移的情况,使得飞控系统无法正确的对无人机的平稳性进行控制。
本发明提供一种解决方案,使飞控系统在无人机受到电磁干扰时能够通过GPS获得的数据正确控制无人机的偏航方向,及根据GPS获得的数据计算获得无人机的加速度信息,根据所述加速度信息对无人机搭载的陀螺仪进行修正,保证陀螺仪提供的数据准确可靠,从而对无人机的横滚角及俯仰角进行修正以保证无人机的平稳性。
参照图1,为本发明控制无人机稳定飞行的方法的第一实施例,所述控制无人机稳定飞行的方法包括:
步骤S100,无人机飞行过程中,飞控系统收集无人机上所搭载的监测装置所返回的监测数据,所述监测装置至少包括:GPS、加速度传感器、陀螺仪和磁力计;
一种可选的实施例中,为提高所述收集无人机搭载的监测装置返回的监测数据的可靠性,采用多次对监测装置数据进行采集得到采集数据,最后对所述采集数据进行平均及加权处理以生成所述无人机搭载的监测装置返回的监测数据。
步骤S200,根据所述监测装置返回的监测数据,至少对所述无人机的飞行航向和平稳性中的一项进行控制;
根据所述GPS返回的监测数据,获得所述无人机在大地坐标系x、y和z方向上的三个速度,以及无人机当前位置的经度和纬度信息,对所述无人机的偏航方向进行控制以保证无人机的飞行航向,并通过所述传感器中包括的陀螺仪返回的监测数据,结合加速度传感器返回的加速度监测信息,对所述无人机的横滚角进行控制,以对所述无人机的平稳性进行控制。
本实施例中,一种可选实施方式的具体实施步骤如下:
1、利用磁力计返回的监测数据计算无人机在x、y和z轴上的磁场信息,由于地磁场以大地坐标系为参考,因此需将所述磁场信息从机体坐标系转到大地坐标系;
2、通过GPS返回的监测数据获取无人机当前位置的经度和纬度信息,并根据所述经度和纬度信息计算出磁偏角,通过磁偏角计算出无人机在x和y方向的磁场信息,计算公式如下:
_mag_earth.x=cosf(_last_declination);//根据所述经度和纬度信息通过余弦函数计算出无人机x方向的磁场;
_mag_earth.y=sinf(_last_declination);//根据所述经度和纬度信息通过正弦函数计算出无人机y方向的磁场;
3、对所述通过所述步骤1获得的磁场信息与所述步骤2获得的磁场信息进行向量叉乘计算获得计算结果,通过所述计算结果获得磁场误差数据,由于无人机的偏航方向只与x,y方向的磁场有关,与z轴方向的磁场无关,因此所述通过所述计算结果获得磁场误差数据与z轴方向上的数据无关;
4、将所述误差数据送入到DCM(DirectionCosineMatrix,方向余弦矩阵)姿态控制算法,完成对无人机偏航方向的修正,达到控制无人机飞行航向的作用。
在本实施例中,通过GPS和磁力计传感器返回的监测数据在无人机飞行过程中对无人机进行控制,使得飞控系统通过GPS和磁力计传感器返回的监测数据控制无人机偏航角,保证无人机能够按照正确的航向飞行。
参照图2,为本发明控制无人机稳定飞行的方法的第二实施例,基于图1所示的实施例,所述根据所述监测装置返回的监测数据,对所述无人机的飞行航向或平稳性进行控制的步骤包括:
步骤S201,根据所述GPS和磁力计返回的监测数据判断磁力计是否失效;
飞控系统通过收集到的所述数据对根据磁力计获得的无人机偏航方向误差判断磁力计是否失效,磁力计失效的原因可能由电磁干扰和/或无人机在强磁场环境下工作引起。
步骤S202,当判断到磁力计已失效时,根据GPS返回的监测数据计算无人机偏航角,获得无人机的偏航角误差;
当判断到磁力计已失效时,飞控系统通过获取GPS返回的信息计算出无人机偏航角,并通过所述偏航角更进一步的获得无人机的偏航角误差。
步骤S203,根据所述偏航角误差控制所述无人机的偏航方向;
飞控系统通过所述偏航角误差通过DCM姿态控制算法从而完成对偏航方向的控制,使得无人机能够保持正确的偏航方向。
具体实施时,本实施例所述步骤具体如下:
1、在无人机飞行过程中,飞控系统通过磁力计获得的数据计算出无人机机体x、y和z轴的磁场向量,由于地磁场以大地坐标系为参考,因此需要将所述磁场从机体坐标系转换到大地坐标系中;
2、飞控系统通过GPS返回的数据获取无人机当前位置的经度和纬度信息,并通过所述经度和纬度信息计算出磁偏角,进一步的通过所述磁偏角计算出无人机在x和y方向上的磁场向量;
3、根据步骤1所述获得的磁场向量与步骤2所获得的磁场向量进行叉乘计算后获得偏航角误差,飞控系统根据所述偏航角误差控制无人机偏航方向;
4、飞控系统根据GPS返回的数据获得无人机沿大地坐标系x和y方向的速度,并根据所述沿大地坐标系x和y方向的速度进行反正切函数计算得到无人机偏航角,较佳的实施方式可以通过如下代码计算得到无人机偏航角:
atan2f(istate.velocity.y,istate.velocity.x);
5、将所述无人机偏航角与步骤3中通过磁力计返回的数据计算获得的无人机偏航角进行差值运算,获得差值并求取所述差值的绝对值,判断所述绝对值是超过预设阀值,若超过则判断磁力计已失效;
6、当磁力计失效时根据所述步骤4获得的无人机偏航角和上一时刻无人机偏航角获得无人机的偏航角误差,即以上一时刻无人机偏航角为基准,计算获得无人机的偏航角误差,将所述无人机的偏航角误差送入到DCM姿态控制算法,从而对无人机的偏航方向进行控制。
在本实施例中,通过上述方案使用GPS数据在磁力计受到电磁干扰时对无人机进行偏航角控制,使得无人机具有更为广泛的应用范围,并且保证无人机在强磁场环境下依然能够正常飞行,避免了磁力计在收到电磁干扰时,返回数据不准确导致无人机无法正确控制偏航方向最后可能带来无人机坠机等灾难性的问题。
进一步的,参照图3,为本发明控制无人机稳定飞行的方法的第三实施例,基于图1所示的实施例,所述根据所述监测装置返回的监测数据,对所述无人机的平稳性进行控制的步骤包括:
步骤S211,将所述加速度传感器返回的监测数据通过旋转矩阵获得无人机机体x、y和z轴三个方向上的加速度信息A;
通过加速度传感器直接获取加速度数据,并通过旋转矩阵将其转换到机体坐标系下,由此得到无人机机体x、y和z轴三个方向上的加速度信息A,其中较佳的实施方式为,若无人机搭载多套健康的加速度传感器,则将所述多套健康的传感器返回的监测数据进行融合后用于计算加速度信息A;
步骤S212,根据所述GPS返回的监测数据获得无人机沿大地坐标系中x、y和z三个方向上的速度,并根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B;
根据所述数据获得无人机沿大地坐标系中x、y和z方向上的速度信息后,根据固定时间间隔内飞行器速度的变化量计算出无人机x、y和z轴三个方向上的加速度信息,并通过叠加重力方向的加速度信息得到无人机在机体坐标系下的实际加速度信息,对所述实际加速度信息进行归一化处理后生成加速度信息B。
较佳实施例中,根据所述GPS返回的监测数据获得无人机沿大地坐标系中x、y和z三个方向上的速度的具体实现代码为:
velovity=_gps.velocity();//直接通过GPS获取groudvelocity数据
根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B;
一种较佳的实施例中,如果所述无人机没有搭载GPS或GPS没有一个好的目标锁定或GPS收到的卫星数少于6个,则GPS返回的监测数据存在不准确的情况,此时GPS不能使用,因此采用空速传感器获取airspeed(空速),再通过DCM旋转矩阵将airspeed转换到地理坐标系下,在考虑风速影响后即为最终机体相对地理坐标系下的速度;
根据所述机体相对地理坐标系下的速度获得无人机沿大地坐标系中x、y和z三个方向上的速度;
根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B。
步骤S213,对加速度信息A与加速度信息B进行向量叉乘获得计算结果;
根据加速度信息A与加速度信息B进行向量叉乘,获得的结果为陀螺仪的漂移误差,根据所述漂移误差对陀螺仪进行修正,从而控制无人机的正常飞行。
步骤S214,根据所述计算结果对无人机的横滚角和俯仰角进行修正,对所述无人机的平稳性进行控制;
具体实施时,所述步骤具体为:
1、利用无人机搭载的加速度传感器获取加速度信息,并通过旋转矩阵将其转换到机体坐标系中,若机体存在多个健康的加速度传感器,则将多个加速度传感器的数据进行融合后作为最终加速度信息A;
2、根据所述数据判断GPS状态,若没有GPS、GPS锁定目标不满足预设条件或GPS收到的卫星数少于预设值,则GPS状态为不可用,反之,则GPS状态为可用;若GPS状态为不可用时,通过空速传感器获取无人机的空速,再通过DCM旋转矩阵将其转换到大地坐标系中,在考虑风速影响后得到无人机沿大地坐标系中x、y和z方向上的速度;若GPS状态为可用时,根据所述数据中GPS返回的数据获得无人机沿大地坐标系中x、y和z方向上的速度;
3、获得速度信息后,根据固定时间间隔内飞行器速度的变化量计算出无人机x、y和z轴三个方向上的加速度信息,并通过叠加重力方向的加速度信息并经过归一化处理得到无人机在机体坐标系下的实际加速度信息,对所述实际加速度信息进行归一化处理后生成加速度信息B;
4、根据加速度信息A与加速度信息B进行向量叉乘,获得的结果为陀螺仪的漂移误差,通过PI(ProportionalIntegral,比例/积分)控制器计算控制量的输出对陀螺仪进行修正,从而控制无人机的正常飞行。
在本实施例中,通过使用获取无人机速度信息计算无人机加速度信息,并通过与由加速度传感器获得的加速度信息进行计算获得漂移误差,最后对陀螺仪进行修正,由此保证无人机在陀螺仪发生漂移后,及时对其进行修正,使得飞控系统依然能够获得正确数据,从而控制无人机正常飞行。
参照图4,为本发明控制无人机稳定飞行的装置的第一实施例,所述控制无人机稳定飞行的装置包括:
数据收集模块100,用于在无人机飞行过程中,飞控系统收集无人机上所搭载的监测装置所返回的监测数据,所述监测装置至少包括:GPS、加速度传感器、陀螺仪和磁力计;
一种可选的实施例中,为提高所述收集无人机搭载的监测装置返回的监测数据的可靠性,采用多次对监测装置数据进行采集得到采集数据,最后对所述采集数据进行平均及加权处理以生成所述无人机搭载的监测装置返回的监测数据。
飞行控制模块200,用于根据所述监测装置返回的监测数据,至少对所述无人机的飞行航向和平稳性中的一项进行控制;
根据所述GPS返回的监测数据,获得所述无人机的在大地坐标系x、y和z方向上的三个速度,以及无人机当前位置的经度和纬度信息,对所述无人机的偏航方向进行控制以保证无人机的飞行航向,并通过所述传感器中包括的陀螺仪返回的监测数据,结合其他传感器返回的加速度监测信息,对所述无人机的横滚角进行控制,以对所述无人机的平稳性进行控制。
本市实施例中,一种可选实施方式的具体实施步骤如下:
1、利用磁力计返回的监测数据计算无人机在x、y和z轴上的磁场信息,由于地磁场以大地坐标系为参考,因此需将所述磁场信息从机体坐标系转到大地坐标系;
2、通过GPS返回的监测数据获取无人机当前位置的经度和纬度信息,并根据所述经度和纬度信息计算出磁偏角,通过磁偏角计算出无人机在x和y方向的磁场信息,计算公式如下:
_mag_earth.x=cosf(_last_declination);//根据所述经度和纬度信息通过余弦函数计算出无人机x方向的磁场;
_mag_earth.y=sinf(_last_declination);//根据所述经度和纬度信息通过正弦函数计算出无人机y方向的磁场;
3、对所述通过所述步骤1获得的磁场信息与所述步骤2获得的磁场信息进行向量叉乘计算获得计算结果,通过所述计算结果获得磁场误差数据,由于无人机的偏航方向只与x,y方向的磁场有关,与z轴方向的磁场无关,因此所述通过所述计算结果获得磁场误差数据与z轴方向上的数据无关;
4、将所述误差数据送入到DCM姿态控制算法,完成对无人机偏航方向的修正,达到控制无人机飞行航向的作用。
在本实施例中,通过GPS和磁力计传感器返回的监测数据在无人机飞行过程中对无人机进行控制,使得飞控系统通过GPS和磁力计传感器返回的监测数据控制无人机偏航角,保证无人机能够按照正确的航向飞行。
参照图5,为本发明控制无人机稳定飞行的装置的第二实施例,基于图4所示的实施例,所述飞行控制模块200包括:
判断单元201,用于根据所述GPS和磁力计返回的监测数据判断磁力计是否失效;
通过收集到的所述数据对根据磁力计获得的无人机偏航方向误差判断磁力计是否失效,磁力计失效的原因可能由电磁干扰和/或无人机在强磁场环境下工作引起。
误差获取单元202,用于当判断到磁力计已失效时,根据GPS返回的监测数据计算无人机偏航角,获得无人机的偏航角误差;
当判断到磁力计已失效时,误差获取单元202通过获取GPS返回的信息计算出无人机偏航角,并通过所述偏航角更进一步的获得无人机的偏航角误差。
方向控制单元203,用于根据所述偏航角误差控制所述无人机的偏航方向;
方向控制单元203通过所述偏航角误差通过DCM姿态控制算法从而完成对偏航方向的控制,使得无人机能够保持正确的偏航方向。
具体实施时,本实施例所述步骤具体如下:
1、在无人机飞行过程中,数据收集模块100通过磁力计获得的数据计算出无人机机体x、y和z轴的磁场向量,由于地磁场以大地坐标系为参考,因此需要将所述磁场从机体坐标系转换到大地坐标系中;
2、判断单元201通过GPS返回的数据获取无人机当前位置的经度和纬度信息,并通过所述经度和纬度信息计算出磁偏角,进一步的通过所述磁偏角计算出无人机在x和y方向上的磁场向量;
3、根据步骤1所述获得的磁场向量与步骤2所获得的磁场向量进行叉乘计算后获得偏航角误差,根据所述偏航角误差控制无人机偏航方向;
4、根据GPS返回的数据获得无人机沿大地坐标系x和y方向的速度,并根据所述沿大地坐标系x和y方向的速度进行反正切函数计算得到无人机偏航角,较佳的实施方式可以通过如下代码计算得到无人机偏航角:
atan2f(istate.velocity.y,istate.velocity.x);
5、将所述无人机偏航角与步骤3中通过磁力计返回的数据计算获得的无人机偏航角进行差值运算,获得差值并求取所述差值的绝对值,判断所述绝对值是超过预设阀值,若超过则判断磁力计已失效;
6、当磁力计失效时根据所述步骤4获得的无人机偏航角和上一时刻无人机偏航角获得无人机的偏航角误差,即以上一时刻无人机偏航角为基准,计算获得无人机的偏航角误差,将所述无人机的偏航角误差送入到DCM姿态控制算法,从而对无人机的偏航方向进行控制。
在本实施例中,通过上述方案使用GPS数据在磁力计受到电磁干扰时对无人机进行偏航角控制,使得无人机具有更为广泛的应用范围,并且保证无人机在强磁场环境下依然能够正常飞行,避免了磁力计在收到电磁干扰时,返回数据不准确导致无人机无法正确控制偏航方向最后可能带来无人机坠机等灾难性的问题。
进一步的,参照图6,为本发明控制无人机稳定飞行的装置的第三实施例,基于图4所述的实施例,所述飞行控制模块200包括:
直接获取加速度单元211,用于将所述加速度传感器返回的监测数据通过旋转矩阵获得无人机机体x、y和z轴三个方向上的加速度信息A;
通过加速度传感器直接获取加速度数据,并通过旋转矩阵将其转换到机体坐标系下,由此得到无人机机体x、y和z轴三个方向上的加速度信息A,其中较佳的实施方式为,若无人机搭载多套健康的加速度传感器,则将所述多套健康的传感器返回的监测数据进行融合后用于计算加速度信息A;
计算获取加速度单元212,用于根据所述GPS返回的监测数据获得无人机沿大地坐标系中x、y和z三个方向上的速度,并根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B;
根据所述数据获得无人机沿大地坐标系中x、y和z方向上的速度信息后,根据固定时间间隔内飞行器速度的变化量计算出无人机x、y和z轴三个方向上的加速度信息,并通过叠加重力方向的加速度信息得到无人机在机体坐标系下的实际加速度信息,对所述实际加速度信息进行归一化处理后生成加速度信息B。
较佳实施例中,根据所述GPS返回的监测数据获得无人机沿大地坐标系中x、y和z三个方向上的速度的具体实现代码为:
velovity=_gps.velocity();//直接通过GPS获取groudvelocity数据
根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B;
一种较佳的实施例中,如果所述无人机没有搭载GPS或GPS没有一个好的目标锁定或GPS收到的卫星数少于6个,则GPS返回的监测数据存在不准确的情况,此时GPS不能使用,因此采用空速传感器获取airspeed(空速),再通过DCM旋转矩阵将airspeed转换到地理坐标系下,在考虑风速影响后即为最终机体相对地理坐标系下的速度;
根据所述机体相对地理坐标系下的速度获得无人机沿大地坐标系中x、y和z三个方向上的速度;
根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B。
计算单元213,用于对加速度信息A与加速度信息B进行向量叉乘获得计算结果;
根据加速度信息A与加速度信息B进行向量叉乘,获得的结果为陀螺仪的漂移误差,根据所述漂移误差对陀螺仪进行修正,从而控制无人机的正常飞行。
修正控制单元214,用于根据所述计算结果对无人机的横滚角和俯仰角进行修正,对所述无人机的平稳性进行控制;
具体实施时,所述步骤具体为:
1、利用无人机搭载的加速度传感器获取加速度信息,并通过旋转矩阵将其转换到机体坐标系中,若机体存在多个健康的加速度传感器,则将多个加速度传感器的数据进行融合后作为最终加速度信息A;
2、根据所述数据判断GPS状态,若没有GPS、GPS锁定目标不满足预设条件或GPS收到的卫星数少于预设值,则GPS状态为不可用,反之,则GPS状态为可用;若GPS状态为不可用时,通过空速传感器获取无人机的空速,再通过DCM旋转矩阵将其转换到大地坐标系中,在考虑风速影响后得到无人机沿大地坐标系中x、y和z方向上的速度;若GPS状态为可用时,根据所述数据中GPS返回的数据获得无人机沿大地坐标系中x、y和z方向上的速度;
3、获得速度信息后,根据固定时间间隔内飞行器速度的变化量计算出无人机x、y和z轴三个方向上的加速度信息,并通过叠加重力方向的加速度信息并经过归一化处理得到无人机在机体坐标系下的实际加速度信息,对所述实际加速度信息进行归一化处理后生成加速度信息B;
4、根据加速度信息A与加速度信息B进行向量叉乘,获得的结果为陀螺仪的漂移误差,通过PI控制器计算控制量的输出对陀螺仪进行修正,从而控制无人机的正常飞行。
在本实施例中,通过使用获取无人机速度信息计算无人机加速度信息,并通过与由加速度传感器获得的加速度信息进行计算获得漂移误差,最后对陀螺仪进行修正,由此保证无人机在陀螺仪发生漂移后,及时对其进行修正,使得飞控系统依然能够获得正确数据,从而控制无人机正常飞行。
以上仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。
Claims (10)
1.一种控制无人机稳定飞行的方法,其特征在于,所述控制无人机稳定飞行的方法包括以下步骤:
无人机飞行过程中,飞控系统收集无人机上所搭载的监测装置所返回的监测数据,所述监测装置至少包括:GPS、加速度传感器、陀螺仪和磁力计;
根据所述监测装置返回的监测数据,至少对所述无人机的飞行航向和平稳性中的一项进行控制。
2.如权利要求1所述的方法,其特征在于,所述根据所述监测装置返回的监测数据,对所述无人机的飞行航向进行控制的步骤包括:
根据所述GPS和磁力计返回的监测数据判断磁力计是否失效;
当判断到磁力计已失效时,根据GPS返回的监测数据计算无人机偏航角,获得无人机的偏航角误差;
根据所述偏航角误差控制所述无人机的偏航方向。
3.如权利要求2所述的方法,其特征在于,所述根据所述GPS和磁力计返回的监测数据判断磁力计是否失效的步骤包括:
根据GPS返回的监测数据获得无人机偏航角A;
根据磁力计返回的监测数据获得无人机偏航角B;
计算获得偏航角A与偏航角B的差的绝对值,若所述绝对值大于预设阀值,则判断磁力计已失效,否则,判断磁力计正常。
4.如权利要求2或3所述的方法,其特征在于,所述当判断到磁力计已失效时,根据GPS返回的监测数据计算无人机偏航角,获得无人机的偏航角误差的步骤包括:
根据GPS返回的监测数据获得无人机沿大地坐标系x,y方向的速度;
根据所述无人机沿大地坐标系x,y方向的速度计算得到无人机偏航角;
根据所述无人机偏航角和上一时刻无人机偏航角获得无人机的偏航角误差。
5.如权利要求1所述的方法,其特征在于,根据所述监测装置返回的监测数据,对所述无人机的平稳性进行控制的步骤包括:
将所述加速度传感器返回的监测数据通过旋转矩阵获得无人机机体x、y和z轴三个方向上的加速度信息A;
根据所述GPS返回的监测数据获得无人机沿大地坐标系中x、y和z三个方向上的速度,并根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B;
对加速度信息A与加速度信息B进行向量叉乘获得计算结果;
根据所述计算结果对无人机的横滚角和俯仰角进行修正,对所述无人机的平稳性进行控制。
6.一种控制无人机稳定飞行的装置,其特征在于,所述控制无人机稳定飞行的装置包括:
数据收集模块,用于在无人机飞行过程中,飞控系统收集无人机搭载的监测装置返回的监测数据,所述监测装置至少包括:GPS、加速度传感器、陀螺仪和磁力计;
飞行控制模块,用于根据所述监测装置返回的监测数据,至少对所述无人机的飞行航向和平稳性中的一项进行控制。
7.如权利要求6所述的装置,其特征在于,所述飞行控制模块包括:
判断单元,用于根据所述GPS和磁力计返回的监测数据判断磁力计是否失效;
误差获取单元,用于当判断到磁力计已失效时,根据GPS返回的监测数据计算无人机偏航角,获得无人机的偏航角误差;
方向控制单元,用于根据所述偏航角误差控制所述无人机的偏航方向。
8.如权利要求7所述的装置,其特征在于,所述判断单元包括:
GPS偏航角获取单元,用于根据GPS返回的监测数据获得无人机偏航角A;
磁力计偏航角获取单元,用于根据磁力计返回的监测数据获得无人机偏航角B;
计算判断单元,用于计算获得偏航角A与偏航角B的差的绝对值,若所述绝对值大于预设阀值,则判断磁力计已失效,否则,判断磁力计正常。
9.如权利要求7或8所述的装置,其特征在于,所述误差获取单元包括:
速度获取单元,用于根据GPS返回的监测数据获得无人机沿大地坐标系x,y方向的速度;
偏航角获取单元,用于根据所述无人机沿大地坐标系x,y方向的速度计算得到无人机偏航角;
偏航角误差获取单元,用于根据所述无人机偏航角和上一时刻无人机偏航角获得无人机的偏航角误差。
10.如权利要求6所述的装置,其特征在于,所述飞行控制模块还包括:
直接获取加速度单元,用于将加速度传感器返回的监测数据通过旋转矩阵获得无人机机体x、y和z轴三个方向上的加速度信息A;
计算获取加速度单元,用于根据所述GPS返回的监测数据获得无人机沿大地坐标系中x、y和z三个方向上的速度,并根据所述x、y和z三个方向上的速度获得无人机机体x、y和z轴三个方向上的加速度信息B;
计算单元,用于对加速度信息A与加速度信息B进行向量叉乘获得计算结果;
修正控制单元,用于根据所述计算结果对无人机的横滚角和俯仰角进行修正,对所述无人机的平稳性进行控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510897158.8A CN105511484A (zh) | 2015-11-27 | 2015-11-27 | 控制无人机稳定飞行的方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510897158.8A CN105511484A (zh) | 2015-11-27 | 2015-11-27 | 控制无人机稳定飞行的方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105511484A true CN105511484A (zh) | 2016-04-20 |
Family
ID=55719544
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510897158.8A Pending CN105511484A (zh) | 2015-11-27 | 2015-11-27 | 控制无人机稳定飞行的方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105511484A (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107976195A (zh) * | 2017-11-30 | 2018-05-01 | 达闼科技(北京)有限公司 | 机器人的定位导航系统及方法、存储介质、机器人 |
CN108521806A (zh) * | 2017-05-23 | 2018-09-11 | 深圳市大疆创新科技有限公司 | 一种航向修正方法、设备及飞行器 |
WO2018214166A1 (zh) * | 2017-05-26 | 2018-11-29 | 广州极飞科技有限公司 | 无人机航向确定方法和无人机 |
CN109839113A (zh) * | 2019-03-18 | 2019-06-04 | 成都中科遥数智创科技有限公司 | 一种控制无人机超视距丢gps后返航到home位置的方法及装置 |
CN110058288A (zh) * | 2019-04-28 | 2019-07-26 | 北京微克智飞科技有限公司 | 无人机ins/gnss组合导航系统航向误差修正方法及系统 |
CN110377058A (zh) * | 2019-08-30 | 2019-10-25 | 深圳市道通智能航空技术有限公司 | 一种飞行器的偏航角修正方法、装置及飞行器 |
CN110417489A (zh) * | 2018-04-26 | 2019-11-05 | 杭州海康机器人技术有限公司 | 一种无人机定向天线的校准方法及装置 |
CN110440805A (zh) * | 2019-08-09 | 2019-11-12 | 深圳市道通智能航空技术有限公司 | 一种偏航角的融合方法、装置及飞行器 |
CN111207736A (zh) * | 2016-07-26 | 2020-05-29 | 广州亿航智能技术有限公司 | 无人机偏航角度的校准方法、系统、设备和可读存储介质 |
CN111721278A (zh) * | 2019-03-22 | 2020-09-29 | 北京京东尚科信息技术有限公司 | 航向角的融合方法和设备 |
CN112525217A (zh) * | 2020-11-19 | 2021-03-19 | 深圳市哈博森科技有限公司 | 一种基于无线电测向的无人机地磁故障检测方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101178313A (zh) * | 2007-12-03 | 2008-05-14 | 哈尔滨工程大学 | 适合于光纤陀螺捷联惯性导航系统的地速检测方法 |
CN101866180A (zh) * | 2010-06-23 | 2010-10-20 | 清华大学 | 一种飞行控制系统 |
CN101989363A (zh) * | 2009-07-30 | 2011-03-23 | 中国商用飞机有限责任公司 | 用于对数字飞行数据进行处理的系统和方法 |
CN203460182U (zh) * | 2013-08-01 | 2014-03-05 | 河北工程大学 | 一种多轴侦察机器人 |
CN103807096A (zh) * | 2014-02-18 | 2014-05-21 | 江苏金风科技有限公司 | 风力涡轮机及其控制方法 |
CN103995529A (zh) * | 2014-05-20 | 2014-08-20 | 西南交通大学 | 一种旋翼飞行器机械安装故障在线诊断方法 |
CN105094138A (zh) * | 2015-07-15 | 2015-11-25 | 东北农业大学 | 一种用于旋翼无人机的低空自主导航系统 |
-
2015
- 2015-11-27 CN CN201510897158.8A patent/CN105511484A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101178313A (zh) * | 2007-12-03 | 2008-05-14 | 哈尔滨工程大学 | 适合于光纤陀螺捷联惯性导航系统的地速检测方法 |
CN101989363A (zh) * | 2009-07-30 | 2011-03-23 | 中国商用飞机有限责任公司 | 用于对数字飞行数据进行处理的系统和方法 |
CN101866180A (zh) * | 2010-06-23 | 2010-10-20 | 清华大学 | 一种飞行控制系统 |
CN203460182U (zh) * | 2013-08-01 | 2014-03-05 | 河北工程大学 | 一种多轴侦察机器人 |
CN103807096A (zh) * | 2014-02-18 | 2014-05-21 | 江苏金风科技有限公司 | 风力涡轮机及其控制方法 |
CN103995529A (zh) * | 2014-05-20 | 2014-08-20 | 西南交通大学 | 一种旋翼飞行器机械安装故障在线诊断方法 |
CN105094138A (zh) * | 2015-07-15 | 2015-11-25 | 东北农业大学 | 一种用于旋翼无人机的低空自主导航系统 |
Non-Patent Citations (1)
Title |
---|
贾峰等: "基于STM32的四旋翼飞行姿态串级控制", 《科学技术与工程》 * |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111207736A (zh) * | 2016-07-26 | 2020-05-29 | 广州亿航智能技术有限公司 | 无人机偏航角度的校准方法、系统、设备和可读存储介质 |
CN108521806B (zh) * | 2017-05-23 | 2019-11-08 | 深圳市大疆创新科技有限公司 | 一种航向修正方法、设备及飞行器 |
CN108521806A (zh) * | 2017-05-23 | 2018-09-11 | 深圳市大疆创新科技有限公司 | 一种航向修正方法、设备及飞行器 |
WO2018214015A1 (zh) * | 2017-05-23 | 2018-11-29 | 深圳市大疆创新科技有限公司 | 一种航向修正方法、设备及飞行器 |
CN110178099B (zh) * | 2017-05-26 | 2022-05-10 | 广州极飞科技股份有限公司 | 无人机航向确定方法和无人机 |
AU2017415194B2 (en) * | 2017-05-26 | 2021-05-27 | Guangzhou Xaircraft Technology Co., Ltd. | Method for determining heading of unmanned aerial vehicle and unmanned aerial vehicle |
KR102271904B1 (ko) * | 2017-05-26 | 2021-07-02 | 광저우 엑스에어크래프트 테크놀로지 씨오 엘티디 | 무인기 비행방향 확정 방법과 무인기 |
CN110178099A (zh) * | 2017-05-26 | 2019-08-27 | 广州极飞科技有限公司 | 无人机航向确定方法和无人机 |
KR20190109478A (ko) * | 2017-05-26 | 2019-09-25 | 광저우 엑스에어크래프트 테크놀로지 씨오 엘티디 | 무인기 비행방향 확정 방법과 무인기 |
US11385059B2 (en) | 2017-05-26 | 2022-07-12 | Guangzhou Xaircraft Technology Co., Ltd | Method for determining heading of unmanned aerial vehicle and unmanned aerial vehicle |
EP3633483A4 (en) * | 2017-05-26 | 2020-12-30 | Guangzhou Xaircraft Technology Co., Ltd. | PROCESS FOR DETERMINING A HEADING OF AN UNPILOT AIR VEHICLE, AND UNPILOT AIR VEHICLE |
WO2018214166A1 (zh) * | 2017-05-26 | 2018-11-29 | 广州极飞科技有限公司 | 无人机航向确定方法和无人机 |
CN107976195B (zh) * | 2017-11-30 | 2019-02-15 | 达闼科技(北京)有限公司 | 机器人的定位导航系统及方法、存储介质、机器人 |
CN107976195A (zh) * | 2017-11-30 | 2018-05-01 | 达闼科技(北京)有限公司 | 机器人的定位导航系统及方法、存储介质、机器人 |
CN110417489A (zh) * | 2018-04-26 | 2019-11-05 | 杭州海康机器人技术有限公司 | 一种无人机定向天线的校准方法及装置 |
CN110417489B (zh) * | 2018-04-26 | 2021-09-17 | 杭州海康机器人技术有限公司 | 一种无人机定向天线的校准方法及装置 |
CN109839113A (zh) * | 2019-03-18 | 2019-06-04 | 成都中科遥数智创科技有限公司 | 一种控制无人机超视距丢gps后返航到home位置的方法及装置 |
CN109839113B (zh) * | 2019-03-18 | 2024-04-26 | 成都中科遥数智创科技有限公司 | 一种控制无人机超视距丢gps后返航到home位置的方法及装置 |
CN111721278A (zh) * | 2019-03-22 | 2020-09-29 | 北京京东尚科信息技术有限公司 | 航向角的融合方法和设备 |
CN110058288B (zh) * | 2019-04-28 | 2021-04-06 | 北京微克智飞科技有限公司 | 无人机ins/gnss组合导航系统航向误差修正方法及系统 |
CN110058288A (zh) * | 2019-04-28 | 2019-07-26 | 北京微克智飞科技有限公司 | 无人机ins/gnss组合导航系统航向误差修正方法及系统 |
WO2021027638A1 (zh) * | 2019-08-09 | 2021-02-18 | 深圳市道通智能航空技术有限公司 | 一种偏航角的融合方法、装置及飞行器 |
CN110440805B (zh) * | 2019-08-09 | 2021-09-21 | 深圳市道通智能航空技术股份有限公司 | 一种偏航角的融合方法、装置及飞行器 |
CN110440805A (zh) * | 2019-08-09 | 2019-11-12 | 深圳市道通智能航空技术有限公司 | 一种偏航角的融合方法、装置及飞行器 |
CN110377058B (zh) * | 2019-08-30 | 2021-11-09 | 深圳市道通智能航空技术股份有限公司 | 一种飞行器的偏航角修正方法、装置及飞行器 |
CN110377058A (zh) * | 2019-08-30 | 2019-10-25 | 深圳市道通智能航空技术有限公司 | 一种飞行器的偏航角修正方法、装置及飞行器 |
CN112525217A (zh) * | 2020-11-19 | 2021-03-19 | 深圳市哈博森科技有限公司 | 一种基于无线电测向的无人机地磁故障检测方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105511484A (zh) | 控制无人机稳定飞行的方法及装置 | |
García Carrillo et al. | Combining stereo vision and inertial navigation system for a quad-rotor UAV | |
US8775063B2 (en) | System and method of lane path estimation using sensor fusion | |
KR20200044420A (ko) | 위치 추정 방법 및 장치 | |
CN103175524B (zh) | 一种无标识环境下基于视觉的飞行器位置与姿态确定方法 | |
CN111077549B (zh) | 位置数据修正方法、装置和计算机可读存储介质 | |
Kiriy et al. | Three-state extended kalman filter for mobile robot localization | |
CN103712598B (zh) | 一种小型无人机姿态确定方法 | |
Yun et al. | IMU/Vision/Lidar integrated navigation system in GNSS denied environments | |
CN102506875B (zh) | 无人机的导航方法及装置 | |
CN104871032A (zh) | 用于提供gnss信号的方法 | |
CN110243364B (zh) | 无人机航向确定方法、装置、无人机及存储介质 | |
CN110637209B (zh) | 估计机动车的姿势的方法、设备和具有指令的计算机可读存储介质 | |
Andert et al. | Optical-aided aircraft navigation using decoupled visual SLAM with range sensor augmentation | |
Niu et al. | Camera-based lane-aided multi-information integration for land vehicle navigation | |
CN104535078A (zh) | 一种基于标志点的光电设备对飞行目标的测量方法 | |
CN106886037B (zh) | 适用于弱gnss信号条件的pos数据纠偏方法 | |
Chen et al. | Real-time tracking a ground moving target in complex indoor and outdoor environments with UAV | |
Zhao et al. | Distributed filtering-based autonomous navigation system of UAV | |
US11061145B2 (en) | Systems and methods of adjusting position information | |
CN113218389B (zh) | 一种车辆定位方法、装置、存储介质及计算机程序产品 | |
KR101656777B1 (ko) | 타칸 정보를 이용한 비행 경로 추종 방법 및 상기 방법을 이용하여 동작하는 장치 | |
CN114877881A (zh) | 一种无人机航向角测量数据的融合方法及融合系统 | |
Deneault et al. | Tracking ground targets with measurements obtained from a single monocular camera mounted on an unmanned aerial vehicle | |
Elbahnasawy | GNSS/INS-assisted multi-camera mobile mapping: System architecture, modeling, calibration, and enhanced navigation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160420 |
|
RJ01 | Rejection of invention patent application after publication |