WO2021081781A1 - Heating method for inertial sensor of unmanned robot - Google Patents

Heating method for inertial sensor of unmanned robot Download PDF

Info

Publication number
WO2021081781A1
WO2021081781A1 PCT/CN2019/114135 CN2019114135W WO2021081781A1 WO 2021081781 A1 WO2021081781 A1 WO 2021081781A1 CN 2019114135 W CN2019114135 W CN 2019114135W WO 2021081781 A1 WO2021081781 A1 WO 2021081781A1
Authority
WO
WIPO (PCT)
Prior art keywords
inertial sensor
temperature
unmanned
heating device
heating
Prior art date
Application number
PCT/CN2019/114135
Other languages
French (fr)
Chinese (zh)
Inventor
李佳乘
高京哲
朱誉品
Original Assignee
深圳市大疆创新科技有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 深圳市大疆创新科技有限公司 filed Critical 深圳市大疆创新科技有限公司
Priority to CN201980007911.8A priority Critical patent/CN111656141A/en
Priority to PCT/CN2019/114135 priority patent/WO2021081781A1/en
Publication of WO2021081781A1 publication Critical patent/WO2021081781A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Definitions

  • This application relates to the field of electronic technology, and in particular to an inertial sensor heating method for an unmanned robot.
  • Inertial sensors are a key component of the navigation system of unmanned control robots, and their performance has a relatively important impact on the accuracy of the navigation system.
  • Unmanned control robots can include unmanned aerial vehicles, unmanned vehicles, and unmanned ships.
  • the measurement of inertial sensors has zero offset.
  • the current heating efficiency of the inertial sensor is not high, which causes the inertial sensor to reach the working temperature after a long time.
  • the local storage device of the unmanned robot stores multiple zero-bias parameters at different temperatures, which means that when the factory produces inertial sensors, the inertial sensors need to be calibrated at multiple different temperatures.
  • the zero offset parameters below lead to higher calibration and production costs of the inertial sensor.
  • the embodiment of the present invention provides an inertial sensor heating method of an unmanned robot, which can reduce the calibration and production costs of the inertial sensor.
  • an embodiment of the present invention provides an inertial sensor heating method for an unmanned robot, wherein the unmanned robot includes an inertial sensor and a heating device for heating the inertial sensor, and the method includes: controlling the heating device Heat the inertial sensor to the working temperature; obtain the sensor data output by the inertial sensor at the working temperature; obtain the zero offset parameter of the inertial sensor at the working temperature from the local storage device of the unmanned robot, where the local storage device does not store The zero offset parameters of other temperatures except the working temperature; the sensor data is compensated according to the zero offset parameters to obtain the compensated sensor data; the unmanned robot is positioned according to the compensated sensor data.
  • an unmanned robot including:
  • Memory processor, inertial sensor and heating device
  • the memory stores program codes
  • the processor calls the program code, and when the program code is executed, is used to perform the following operations:
  • the present invention provides an unmanned control robot system, which is characterized in that it includes:
  • the control terminal is used to respond to the user's control operation and control the drone control robot.
  • the inertial sensor is heated to the working temperature; the sensing data output by the inertial sensor at the working temperature is obtained; the zero offset parameter of the inertial sensor at the working temperature is obtained from the local storage device of the unmanned robot, Among them, the local storage device does not store the zero bias parameters of temperatures other than the operating temperature; the sensor data is compensated according to the zero bias parameters to obtain the compensated sensor data; according to the compensated sensor data, the The unmanned robot performs positioning operations. In addition, in the traditional method, when the unmanned robot performs positioning operation, the temperature of the inertial sensor is not heated to the working temperature.
  • the embodiment of the present invention only needs to calibrate the zero-bias parameters of the inertial sensor at one working temperature, which can reduce the calibration and production of the inertial sensor. cost.
  • Figure 1 is a graph of the heating rate of a current inertial sensor
  • Figure 2 is a graph showing the zero offset change curve of the accelerometer of a current inertial sensor on the coordinate axis;
  • FIG. 3 is a schematic diagram of the architecture of an unmanned control system provided by an embodiment of the present invention.
  • FIG. 4 is a diagram of an application scenario when a drone performs a task according to an embodiment of the present invention
  • FIG. 5 is an inertial sensor heating method of an unmanned robot according to an embodiment of the present invention.
  • Figure 6 is the temperature rise curve of the inertial sensor when the operating temperature of the inertial sensor is 65 degrees;
  • Figure 7 is a graph showing the zero offset change curve of the accelerometer of the inertial sensor on the coordinate axis when the operating temperature of the inertial sensor is 65 degrees;
  • Fig. 8 is a schematic structural diagram of an unmanned robot provided by an embodiment of the present invention.
  • the temperature of the inertial sensor has not stabilized during the positioning operation of the inertial sensor, that is, the temperature of the inertial sensor is still rising slowly.
  • the heating speed curve of a current inertial sensor is shown in Fig. 1, and the corresponding temperature T working temperature at t 1 is the working temperature of an unmanned robot.
  • the temperature of the inertial sensor has not reached the working temperature at the time t 0 of the unmanned robot during the positioning operation, that is, the temperature of the inertial sensor is still rising slowly, resulting in
  • the zero offset of the temperature change affects the measurement accuracy of the inertial sensor.
  • the zero bias is affected by temperature. During the temperature rise of the inertial sensor, the zero bias parameters will change with the temperature.
  • Fig. 2 shows the bias change curves of the three coordinate axes (that is, the x-axis, the y-axis, and the z-axis) of the current inertial sensor (Inertial Measurement Unit, IMU) during the heating process.
  • IMU Inertial Measurement Unit
  • the unmanned robot needs to store multiple zero-bias parameters at different temperatures in the local storage device, which means that when the factory produces inertial sensors, it needs to measure and calibrate the inertial sensors at multiple different temperatures.
  • the zero-bias parameters make the production of inertial sensors require a large investment in calibration and production costs.
  • the embodiment of the present invention proposes an inertial sensor heating method for an unmanned robot.
  • the unmanned control robot when the unmanned control robot is turned on, the unmanned control robot responds to the power-on signal of the unmanned control robot to control the heating device to heat the inertial sensor to the working temperature within a preset time; and obtain the The sensing data output by the inertial sensor at the working temperature; from the local storage device of the unmanned robot, the zero bias parameter of the inertial sensor at the working temperature is obtained, and the local storage device does not store the temperature other than the working temperature.
  • Zero-bias parameters compensate the sensor data according to the zero-bias parameters to obtain the compensated sensor data; according to the compensated sensor data, perform positioning operations on the unmanned robot.
  • the unmanned robot can control the heating device to heat the inertial sensor to the working temperature within a preset time, so that the unmanned robot only needs to compensate the sensor data output by the inertial sensor according to the zero offset parameter at a working temperature.
  • the unmanned robot is positioned according to the compensated sensor data at the working temperature, so that the local storage device of the unmanned robot only stores the zero-bias parameters of the inertial sensor at the working temperature. Before the inertial sensor is heated to the working temperature, the zero offset parameter is not used to compensate the sensor data output by the inertial sensor. This method can improve the measurement accuracy of the inertial sensor and reduce the calibration and production cost of the inertial sensor.
  • FIG. 3 is a schematic structural diagram of an unmanned control system according to an embodiment of the present invention.
  • the unmanned control system 30 is composed of an unmanned control robot 301 and a control terminal 302.
  • the unmanned robot 301 includes an inertial sensor 3011 and a heating device 3012.
  • the control terminal 302 is used to control the unmanned robot to move.
  • the inertial sensor 3011 is a sensor that measures acceleration, tilt, impact, vibration, rotation, and multi-degree-of-freedom motion, and is used to output sensor data.
  • the heating device 3012 is used to heat the inertial sensor 3011, and the heating device 3012 can be a heating resistor, a ceramic heating sheet, or an electric heating paint.
  • the heating device 3012 is a heating resistor
  • the heating resistors are arranged adjacent to the inertial sensor, and their number is the preset number threshold to ensure that when the heating resistor heats the inertial sensor with the maximum power, the heating rate of the inertial sensor is greater than the preset heating rate .
  • the inertial measurement unit 3011 may include an accelerometer and a gyroscope.
  • FIG 4 is an application scenario diagram when the drone is performing a task.
  • Point A is the position of the drone when it is started, and point B is the task that the drone needs to perform.
  • the drone needs to perform preset tasks at the task location B, such as taking photos and photography of the characters in the picture.
  • the drone When the drone is activated at point A, the drone responds to the power-on signal and controls the heating device to heat the inertial sensor to the working temperature.
  • the drone heats the inertial sensor to the working temperature within the preset time, so the drone obtains the sensing data of the inertial sensor and the zero offset parameter at the working temperature at point A, and transmits it according to the zero offset parameter at the working temperature.
  • Sensing data is compensated, and the compensated sensing data is obtained. Finally, the UAV is positioned according to the compensated sensor data. If at point A, the inertial sensor is heated to the working temperature, it will move to point B in response to the motion control instruction of the control terminal of the drone. In this method, the temperature of the inertial sensor reaches the working temperature, and it only needs to compensate the sensor data output by the inertial sensor according to the zero offset parameter corresponding to the working temperature at the working temperature. In the subsequent movement and task execution process, There is no need to compensate the sensor data output by the inertial sensor according to the zero offset parameters corresponding to other temperatures of the inertial sensor, which can reduce the calibration and production costs of the inertial sensor.
  • an embodiment of the present invention proposes an inertial sensor heating method for an unmanned robot as shown in FIG. 5, and the inertial sensor heating method for an unmanned robot may include S501-S506:
  • the unmanned robot controls the heating device to heat the inertial sensor to a reference temperature lower than the operating temperature according to the maximum heating power of the heating device.
  • the unmanned robot when the unmanned robot is turned on, the unmanned robot responds to the power-on signal of the unmanned robot and controls the heating device to heat the inertial sensor to a reference value lower than the operating temperature according to the maximum heating power of the heating device. temperature.
  • the heating device can be a heating resistor, a ceramic heating sheet, or an electric heating paint. If the heating device is a heating resistor, the heating resistor is pre-arranged in the adjacent position of the inertial sensor, and its number is greater than the preset number threshold to ensure that the heating resistance is When the inertial sensor is heated with the maximum power, the heating rate of the inertial sensor is not lower than the preset heating rate. For example, the preset heating rate may be greater than or equal to 5 degrees per second.
  • the working temperature of the inertial sensor is higher than the ambient temperature where the unmanned robot is located, and the working temperature can be between 60-90 degrees. In one implementation, the working temperature is set by the user according to the highest ambient temperature at which the unmanned robot can work normally. For example, the maximum ambient temperature at which the unmanned robot can work normally is 60 degrees, and the user sets the operating temperature of the unmanned robot to 75 degrees according to this temperature.
  • the reference temperature may be set according to the working temperature, and the reference temperature is close to and lower than the working temperature.
  • the ratio between the reference temperature and the working temperature is x, n ⁇ x ⁇ 1, for example, n can be 0.8, 0.9, or 0.95, etc.
  • x can make the reference temperature as close to the working temperature as possible.
  • the difference between the operating temperature and the reference temperature is less than a preset threshold, the preset threshold may be 10 degrees or 5 degrees, etc. The preset threshold can make the reference temperature as close to the operating temperature as possible.
  • the unmanned robot when the unmanned robot is turned on by the user, the unmanned robot responds to the power-on signal of the unmanned robot and inputs a pulse modulation voltage with a full duty cycle, so that the unmanned robot will follow
  • the maximum heating power of the heating device controls the heating device to heat the inertial sensor to the reference temperature.
  • the inertial sensor when the unmanned robot controls the inertial sensor to heat according to the maximum power of the heating device, the inertial sensor increases the temperature at least at a preset heating rate, and the preset heating rate is greater than or equal to 5 degrees/ Seconds, the preset heating rate is much higher than the current heating rate of inertial sensors. This preset heating rate can ensure that the temperature of the inertial sensor is quickly heated to the working temperature.
  • the unmanned robot controls the heating device to heat the inertial sensor to the working temperature within a preset time according to the maximum heating power of the heating device, and the preset time is not more than 30 seconds, so that the inertial sensor After the operating temperature is reached quickly, there is no need to compensate the sensor data output by the inertial sensor according to the zero offset parameters corresponding to other temperatures of the inertial sensor, which can reduce the calibration cost of the inertial sensor.
  • the unmanned robot When it is determined that the inertial sensor is heated to the reference temperature, the unmanned robot adopts a closed-loop heating control strategy to control the heating device to heat the inertial sensor to the working temperature.
  • the closed-loop heating control strategy is adopted to control the heating device to heat the inertial sensor to the operating temperature.
  • the closed-loop heating control strategy includes a PI control strategy.
  • the PI control strategy includes linear control parameters and integral control parameters.
  • the linear control parameters are used to adjust the stability of the control system, and the integral control parameters are used to adjust the indifference of the control system.
  • the unmanned control robot adjusts the linear control parameters and integral control parameters of the PI control strategy, so that the inertial sensor rises between the reference temperature and the operating temperature without exceeding the operating temperature. Until the operating temperature is reached.
  • the unmanned robot when the unmanned robot determines that the temperature of the inertial sensor reaches the working temperature, it adjusts the integral control parameters of the PI control strategy to stabilize the temperature of the inertial sensor at the working temperature, ensuring that the inertial sensor is in the subsequent working process. Its temperature remains unchanged at the working temperature.
  • the heating curve of the inertial sensor under this method and the heating curve of the inertial sensor under the traditional method are shown in Fig. 6.
  • This method is an improved method relative to the traditional method, that is, this application.
  • the technical solutions disclosed in the embodiments It can be seen that, compared with the traditional method, under the improved heating method, the temperature of the inertial sensor rises to the working temperature about 20 seconds after power-on and keeps the working temperature stable, while the temperature of the inertial sensor under the traditional method is on the power-up. The working temperature has not been reached after 20 seconds.
  • the heating rate of the inertial sensor under this method is obviously greater than that under the traditional method, so that the temperature of the inertial sensor can quickly rise to the reference temperature, and under the closed-loop control strategy, it rises to the working temperature, and after reaching the working temperature, it is constant at Operating temperature.
  • S503 The unmanned robot obtains the sensing data output by the inertial sensor at the working temperature.
  • the unmanned control robot When it is determined that the temperature of the inertial sensor rises to the working temperature, the unmanned control robot obtains the sensing data output by the inertial sensor at the working temperature.
  • the sensing data can include the attitude of the unmanned control robot, which includes angular velocity and acceleration.
  • the sensing data output by the inertial sensor at the working temperature has zero bias, which cannot be directly used as the sensing data measured by the inertial sensor.
  • the sensing data needs to be compensated according to the zero bias parameters at the working temperature.
  • S504 The unmanned robot obtains the zero offset parameter of the inertial sensor at the working temperature in the local storage device.
  • the measurement of inertial sensors will have a zero offset, and the zero offset is related to temperature. Therefore, it is necessary to compensate the sensor data according to the zero offset parameters at the operating temperature of the inertial sensor. Therefore, it is necessary to obtain the zero offset parameters of the inertial sensor at the working temperature in the local storage device of the unmanned robot in advance.
  • the local storage device does not store the zero offset parameters of other temperatures other than the operating temperature, that is, the unmanned robot does not need to store the zero offset parameters corresponding to other temperature points in advance, which can reduce the calibration cost of the inertial sensor .
  • the zero offset parameter of the inertial sensor at the working temperature is obtained by measuring the inertial sensor when the factory produces the inertial sensor.
  • the working temperature is sent to the factory after the user sets the inertial sensor.
  • the zero-bias parameter of the inertial sensor is obtained by the unmanned robot according to the preset compensation parameter acquisition algorithm and operating temperature, and the inertial sensor is measured.
  • the preset compensation parameter algorithm includes wavelet transform and least square method. , Gray forecasting method, etc., there are no restrictions here.
  • S505 The unmanned robot compensates the sensor data according to the zero offset parameter to obtain the compensated sensor data.
  • the inertial sensor obtained by the unmanned robot has zero bias in the sensing data at the working temperature.
  • the sensor data is compensated according to the zero bias parameters at the working temperature, and the compensated sensing data can be obtained.
  • the compensated sensing data The data is more accurate sensor data.
  • S506 The unmanned robot performs positioning operations on the unmanned robot according to the compensated sensor data.
  • the unmanned control robot After the unmanned control robot obtains the compensated sensor data, it performs positioning operations on the unmanned control robot according to the compensated sensor data.
  • the zero-bias change curve of the inertial sensor under this method and the traditional method is shown in Figure 7.
  • This method is an improved method under the traditional method. It can be seen from the figure that, 20 seconds after power-on, the accelerometer zero bias under the improved method has been basically stable, while the zero bias under the traditional method is still changing.
  • the inertial sensor when the inertial sensor is not heated to the operating temperature, it refuses to respond to the motion control instruction sent by the control terminal. Specifically, when the inertial sensor is not heated to the operating temperature, since the local storage device does not store the zero offset parameters of other temperatures except the operating temperature, that is, the local storage device only stores the zero offset parameters at all temperatures. For the zero offset parameters of the working temperature, the sensing data output by the inertial sensor has not been compensated, resulting in inaccurate positioning of the unmanned control robot. Therefore, it refuses to respond to the motion control instructions sent by the control terminal to ensure safe operation.
  • the unmanned control robot can control the heating device to heat the inertial sensor to the working temperature within a preset time, so that the unmanned control robot only needs to compensate for the sensing data output by one working temperature of the inertial sensor. Improve the measurement accuracy of inertial sensors.
  • the local storage of the unmanned control robot only stores the zero offset parameters of the inertial sensor at the working temperature, which can reduce the calibration and production costs of the inertial sensor.
  • FIG. 8 is a schematic structural diagram of an unmanned control robot provided in an embodiment of the present invention.
  • the unmanned robot 80 includes a memory 801, a processor 802, an inertial sensor 803, and a heating device 804.
  • the memory 801 includes a local storage device, and the local storage device is used to store the inertial sensor 803 at a working temperature.
  • the memory 801 stores program codes, and the processor 802 calls the program codes in the memory 801.
  • the processor 802 performs the following operations:
  • the processor 802 controls the heating device 804 to heat the inertial sensor 803 to a working temperature
  • the working temperature is higher than the ambient temperature of the unmanned robot.
  • the working temperature is between 60-90 degrees.
  • the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature of the working temperature, specifically for:
  • the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature.
  • the heating device 804 is a heating resistor.
  • the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature of the working temperature, specifically for:
  • the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature within a preset time.
  • the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature within a preset time
  • the preset time is not more than 30 seconds.
  • the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature of the working temperature, specifically for:
  • the processor 802 controls the heating device 804 to heat the inertial sensor 803 to a reference temperature lower than the operating temperature according to the maximum heating power of the heating device 804;
  • a closed-loop heating control strategy is adopted to control the heating device 804 to heat the inertial sensor 803 to the working temperature.
  • the closed-loop heating control strategy includes a PI control strategy.
  • the inertial sensor 803 when the processor 802 controls the heating device 804 to heat the inertial sensor 803 with the maximum power, the inertial sensor 803 at least increases the temperature at a heating rate not lower than a preset heating rate.
  • the preset heating rate is greater than or equal to 5 degrees when the inertial sensor 804 increases the temperature at least at a preset heating rate. /second.
  • the processor 802 refuses to respond to the motion control instruction sent by the control terminal.
  • the processor 802 can control the heating device 804 to heat the inertial sensor 803 to the operating temperature within a preset time, so that the processor 802 only needs to perform sensing data output from one operating temperature of the inertial sensor 803. Compensation can improve the measurement accuracy of the inertial sensor 803.
  • the memory 801 only stores the zero offset parameters corresponding to the inertial sensor 803 at the working temperature, which can reduce the production cost of the inertial sensor 803.
  • the embodiment of the present invention also provides an unmanned control robot system, the unmanned control robot system includes:
  • the unmanned control robot provided in the foregoing embodiment
  • control terminal is used to respond to the user's control operation and control the drone control robot.
  • the unmanned control robot includes at least one of the following: unmanned aerial vehicles, unmanned vehicles, and unmanned ships.

Landscapes

  • Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Manipulator (AREA)

Abstract

A heating method for an inertial sensor of an unmanned robot. The heating method for an inertial sensor of an unmanned robot comprises: controlling a heating device to heat an inertial sensor to a working temperature; obtaining sensing data output by the inertial sensor at the working temperature; obtaining a bias parameter of the inertial sensor at the working temperature from a local storage device of the unmanned robot; compensating for the sensing data according to the bias parameter to obtain compensated sensing data; and performing positioning operation on the unmanned robot on the basis of the compensated sensing data. The use of the method can effectively reduce calibration and production costs of inertial sensors.

Description

一种无人控制机器人的惯性传感器加热方法Inertial sensor heating method of unmanned robot 技术领域Technical field
本申请涉及电子技术领域,尤其涉及一种无人控制机器人的惯性传感器加热方法。This application relates to the field of electronic technology, and in particular to an inertial sensor heating method for an unmanned robot.
背景技术Background technique
惯性传感器是无人控制机器人的导航系统中的关键组成部分,其工作性能对于导航系统的精度有着较为重要的影响,无人控制机器人可包括无人机、无人驾驶汽车、无人船等。Inertial sensors are a key component of the navigation system of unmanned control robots, and their performance has a relatively important impact on the accuracy of the navigation system. Unmanned control robots can include unmanned aerial vehicles, unmanned vehicles, and unmanned ships.
惯性传感器的测量存在零偏,为了准确测量,需要通过标定的方式确定惯性传感器的零偏参数,使用零偏参数对惯性传感器输出的传感数据进行补偿。然而,目前对惯性传感器的加热效率不高,导致惯性传感器在较长的时间后才能达到工作温度。这样,为了有效地实现准确的定位,无人控制机器人的本地存储装置中存储多个不同温度下的零偏参数,意味着工厂在生产惯性传感器时,需要标定所述惯性传感器在多个不同温度下的零偏参数,导致惯性传感器的标定和生产成本较高。The measurement of inertial sensors has zero offset. In order to measure accurately, it is necessary to determine the zero offset parameters of the inertial sensor through calibration, and use the zero offset parameters to compensate the sensor data output by the inertial sensor. However, the current heating efficiency of the inertial sensor is not high, which causes the inertial sensor to reach the working temperature after a long time. In this way, in order to effectively achieve accurate positioning, the local storage device of the unmanned robot stores multiple zero-bias parameters at different temperatures, which means that when the factory produces inertial sensors, the inertial sensors need to be calibrated at multiple different temperatures. The zero offset parameters below lead to higher calibration and production costs of the inertial sensor.
发明内容Summary of the invention
本发明实施例提供了一种无人控制机器人的惯性传感器加热方法,可降低惯性传感器的标定和生产成本。The embodiment of the present invention provides an inertial sensor heating method of an unmanned robot, which can reduce the calibration and production costs of the inertial sensor.
第一方面,本发明实施例提供了一种无人控制机器人的惯性传感器加热方法,其中,无人控制机器人包括惯性传感器和用于对惯性传感器进行加热的加热装置,该方法包括:控制加热装置将惯性传感器加热至工作温度;获取惯性传感器在工作温度输出的传感数据;从无人控制机器人的本地存储装置中,获取惯性传感器在工作温度的零偏参数,其中,本地存储装置中不存储除工作温度之外的其他温度的零偏参数;根据零偏参数对传感数据进行补偿,以获取补偿后的传感数据;根据补偿后的传感数据,对无人控制机器人进行定位操作。In a first aspect, an embodiment of the present invention provides an inertial sensor heating method for an unmanned robot, wherein the unmanned robot includes an inertial sensor and a heating device for heating the inertial sensor, and the method includes: controlling the heating device Heat the inertial sensor to the working temperature; obtain the sensor data output by the inertial sensor at the working temperature; obtain the zero offset parameter of the inertial sensor at the working temperature from the local storage device of the unmanned robot, where the local storage device does not store The zero offset parameters of other temperatures except the working temperature; the sensor data is compensated according to the zero offset parameters to obtain the compensated sensor data; the unmanned robot is positioned according to the compensated sensor data.
第二方面,本发明实施例提供了一种无人控制机器人,包括:In the second aspect, an embodiment of the present invention provides an unmanned robot, including:
存储器、处理器、惯性传感器以及加热装置;Memory, processor, inertial sensor and heating device;
所述存储器存储程序代码;The memory stores program codes;
所述处理器,调用所述程序代码,当程序代码被执行时,用于执行以下操作:The processor calls the program code, and when the program code is executed, is used to perform the following operations:
控制加热装置将惯性传感器加热至工作温度;获取惯性传感器在工作温度输出的传感数据;从无人控制机器人的本地存储装置中,获取惯性传感器在工作温度的零偏参数,其中,本地存储装置中不存储除工作温度之外的其他温度的零偏参数;根据零偏参数对所述传感数据进行补偿,以获取补偿后的传感数据;根据补偿后的传感数据,对无人控制机器人进行定位操作。Control the heating device to heat the inertial sensor to the working temperature; obtain the sensor data output by the inertial sensor at the working temperature; obtain the zero bias parameter of the inertial sensor at the working temperature from the local storage device of the unmanned robot, where the local storage device It does not store the zero offset parameters of other temperatures except the working temperature; compensate the sensor data according to the zero offset parameters to obtain the compensated sensor data; according to the compensated sensor data, control the unmanned The robot performs positioning operations.
第三方面,本发明提供了一种无人控制机器人系统,其特征在于,包括:In the third aspect, the present invention provides an unmanned control robot system, which is characterized in that it includes:
如第二方面所述无人控制机器人;The unmanned robot as described in the second aspect;
控制终端,用于响应用户的控制操作,并对所述无人机控制机器人进行控制。The control terminal is used to respond to the user's control operation and control the drone control robot.
本发明实施例中,将惯性传感器加热至工作温度;获取所述惯性传感器在工作温度输出的传感数据;从无人控制机器人的本地存储装置中,获取惯性传感器在工作温度的零偏参数,其中,本地存储装置中不存储除工作温度之外的其他温度的零偏参数;根据零偏参数对传感数据进行补偿,以获取补偿后的传感数据;根据补偿后的传感数据,对无人控制机器人进行定位操作。另外,传统方法中,无人控制机器人进行定位操作时,惯性传感器的温度未加热至工作温度,需要根据惯性传感器在多个温度下的零偏参数,对惯性传感器在不同温度时输出的传感数据进行补偿,基于此,需要预先标定惯性传感器在多个温度下的零偏参数,而本发明实施例仅需标定惯性传感器在一个工作温度下的零偏参数,可降低惯性传感器的标定和生产成本。In the embodiment of the present invention, the inertial sensor is heated to the working temperature; the sensing data output by the inertial sensor at the working temperature is obtained; the zero offset parameter of the inertial sensor at the working temperature is obtained from the local storage device of the unmanned robot, Among them, the local storage device does not store the zero bias parameters of temperatures other than the operating temperature; the sensor data is compensated according to the zero bias parameters to obtain the compensated sensor data; according to the compensated sensor data, the The unmanned robot performs positioning operations. In addition, in the traditional method, when the unmanned robot performs positioning operation, the temperature of the inertial sensor is not heated to the working temperature. It is necessary to sense the output of the inertial sensor at different temperatures based on the zero offset parameters of the inertial sensor at multiple temperatures. Data is compensated. Based on this, it is necessary to pre-calibrate the zero-bias parameters of the inertial sensor at multiple temperatures. However, the embodiment of the present invention only needs to calibrate the zero-bias parameters of the inertial sensor at one working temperature, which can reduce the calibration and production of the inertial sensor. cost.
附图说明Description of the drawings
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的 前提下,还可以根据这些附图获得其他的附图。In order to explain the embodiments of the present application or the technical solutions in the prior art more clearly, the following will briefly introduce the drawings that need to be used in the embodiments. Obviously, the drawings in the following description are only some of the present application. Embodiments, for those of ordinary skill in the art, without creative work, other drawings can be obtained based on these drawings.
图1为目前的一种惯性传感器的加热速度曲线图;Figure 1 is a graph of the heating rate of a current inertial sensor;
图2为目前的一种惯性传感器的加速度计在坐标轴的零偏变化曲线图;Figure 2 is a graph showing the zero offset change curve of the accelerometer of a current inertial sensor on the coordinate axis;
图3为本发明实施例提供的一种无人控制系统的架构示意图;3 is a schematic diagram of the architecture of an unmanned control system provided by an embodiment of the present invention;
图4为本发明实施例提供的一种无人机执行任务时的一个应用场景图;FIG. 4 is a diagram of an application scenario when a drone performs a task according to an embodiment of the present invention;
图5为本发明实施例提供的一种无人控制机器人的惯性传感器加热方法;FIG. 5 is an inertial sensor heating method of an unmanned robot according to an embodiment of the present invention;
图6为惯性传感器的工作温度为65度时,惯性传感器的升温曲线图;Figure 6 is the temperature rise curve of the inertial sensor when the operating temperature of the inertial sensor is 65 degrees;
图7为惯性传感器的工作温度为65度时,惯性传感器的加速度计在坐标轴的零偏变化曲线图;Figure 7 is a graph showing the zero offset change curve of the accelerometer of the inertial sensor on the coordinate axis when the operating temperature of the inertial sensor is 65 degrees;
图8为本发明实施例提供的一种无人控制机器人的结构示意图。Fig. 8 is a schematic structural diagram of an unmanned robot provided by an embodiment of the present invention.
具体实施方式Detailed ways
下面结合本发明实施例中的附图对本发明实施例进行描述。The embodiments of the present invention will be described below in conjunction with the drawings in the embodiments of the present invention.
目前,在惯性传感器的温度稳定之前,由于惯性传感器加热速度较慢,导致惯性传感器进行定位操作时,惯性传感器温度未达到稳定,即惯性传感器温度仍在缓慢上升。例如,目前的一种惯性传感器的加热速度曲线如图1所示,t 1时刻对应的温度T 工作温度为无人控制机器人的工作温度。如图可以看出,由于惯性传感器的加热速度较慢,导致无人控制机器人在进行定位操作时刻t 0时,惯性传感器的温度未达到工作温度,即惯性传感器的温度仍在缓慢上升,导致随着温度变化的零偏影响惯性传感器的测量精度。零偏受温度影响,在惯性传感器的温度上升的过程中,零偏参数会随温度的变化而变化。图2为目前的惯性传感器(Inertial Measurement Unit,IMU)在升温过程中,三个坐标轴(即x轴、y轴以及z轴)的零偏(bias)变化曲线。可以看出,随着温度的升高,三个坐标轴的零偏都在增加,其中z轴的零偏变化最为明显。因此,为消除零偏对定位操作的影响,需要获得惯性传感器在到达工作温度之前的多个不同温度点对应多个零偏参数,根据各个零偏参数在对应的温度点对对应的传感数据进行多次补偿。为了实现上述方案,无人控制机器人需要在本地存储装置中存储多个不同温度下的零偏参数,意味着工厂在生产惯性传感器时,需要测量和 标定所述惯性传感器在多个不同温度下的零偏参数,使得惯性传感器的生产需要投入较大的标定和生产成本。 At present, before the temperature of the inertial sensor is stabilized, due to the slow heating speed of the inertial sensor, the temperature of the inertial sensor has not stabilized during the positioning operation of the inertial sensor, that is, the temperature of the inertial sensor is still rising slowly. For example, the heating speed curve of a current inertial sensor is shown in Fig. 1, and the corresponding temperature T working temperature at t 1 is the working temperature of an unmanned robot. As can be seen from the figure, due to the slow heating speed of the inertial sensor, the temperature of the inertial sensor has not reached the working temperature at the time t 0 of the unmanned robot during the positioning operation, that is, the temperature of the inertial sensor is still rising slowly, resulting in The zero offset of the temperature change affects the measurement accuracy of the inertial sensor. The zero bias is affected by temperature. During the temperature rise of the inertial sensor, the zero bias parameters will change with the temperature. Fig. 2 shows the bias change curves of the three coordinate axes (that is, the x-axis, the y-axis, and the z-axis) of the current inertial sensor (Inertial Measurement Unit, IMU) during the heating process. It can be seen that as the temperature increases, the zero offsets of the three coordinate axes are increasing, and the zero offset of the z-axis changes most obviously. Therefore, in order to eliminate the influence of the zero offset on the positioning operation, it is necessary to obtain the multiple zero offset parameters corresponding to the multiple different temperature points of the inertial sensor before reaching the working temperature, and the corresponding sensor data at the corresponding temperature points according to each zero offset parameter Make multiple compensations. In order to achieve the above solution, the unmanned robot needs to store multiple zero-bias parameters at different temperatures in the local storage device, which means that when the factory produces inertial sensors, it needs to measure and calibrate the inertial sensors at multiple different temperatures. The zero-bias parameters make the production of inertial sensors require a large investment in calibration and production costs.
本发明实施例提出了一种无人控制机器人的惯性传感器加热方法。该方法中,当无人控制机器人的被开启时,无人控制机器人响应于所述无人控制机器人的开机信号,控制加热装置在预设时间内,将惯性传感器加热至工作温度;获取所述惯性传感器在工作温度输出的传感数据;从无人控制机器人的本地存储装置中,获取惯性传感器在工作温度的零偏参数,其中,本地存储装置中不存储除工作温度之外的其他温度的零偏参数;根据零偏参数对传感数据进行补偿,以获取补偿后的传感数据;根据补偿后的传感数据,对无人控制机器人进行定位操作。无人控制机器人可控制加热装置,将惯性传感器在预设时间内加热到工作温度,使得无人控制机器人只需要根据一个工作温度下的零偏参数,对惯性传感器输出的传感数据进行补偿,并在工作温度下根据补偿后的传感数据对无人控制机器人进行定位操作,从而无人控制机器人的本地存储装置中只存储惯性传感器在工作温度下的零偏参数。在惯性传感器被加热到工作温度之前,不使用零偏参数对惯性传感器输出的传感数据进行补偿。该方式可提高惯性传感器的测量精度和降低惯性传感器的标定和生产成本。The embodiment of the present invention proposes an inertial sensor heating method for an unmanned robot. In this method, when the unmanned control robot is turned on, the unmanned control robot responds to the power-on signal of the unmanned control robot to control the heating device to heat the inertial sensor to the working temperature within a preset time; and obtain the The sensing data output by the inertial sensor at the working temperature; from the local storage device of the unmanned robot, the zero bias parameter of the inertial sensor at the working temperature is obtained, and the local storage device does not store the temperature other than the working temperature. Zero-bias parameters; compensate the sensor data according to the zero-bias parameters to obtain the compensated sensor data; according to the compensated sensor data, perform positioning operations on the unmanned robot. The unmanned robot can control the heating device to heat the inertial sensor to the working temperature within a preset time, so that the unmanned robot only needs to compensate the sensor data output by the inertial sensor according to the zero offset parameter at a working temperature. The unmanned robot is positioned according to the compensated sensor data at the working temperature, so that the local storage device of the unmanned robot only stores the zero-bias parameters of the inertial sensor at the working temperature. Before the inertial sensor is heated to the working temperature, the zero offset parameter is not used to compensate the sensor data output by the inertial sensor. This method can improve the measurement accuracy of the inertial sensor and reduce the calibration and production cost of the inertial sensor.
为了更好的理解本发明实施例公开的一种无人控制机器人的惯性传感器加热方法,下面首先对本发明实施例适用的无人机控制机器人的架构进行描述。In order to better understand the inertial sensor heating method of the unmanned robot disclosed in the embodiment of the present invention, the following first describes the architecture of the unmanned aerial vehicle control robot applicable to the embodiment of the present invention.
请参见图3,图3是本发明实施例提供的一种无人控制系统的架构示意图。如图3所示,该无人控制系统30由无人控制机器人301和控制终端302组成。其中,无人控制机器人301包括惯性传感器3011和加热装置3012。控制终端302用于控制无人控制机器人进行运动。惯性传感器3011是一种测量加速度、倾斜、冲击、振动、旋转和多自由度运动传感器,用于输出传感数据。加热装置3012用于加热所述惯性传感器3011,加热装置3012可以为加热电阻、陶瓷发热片或电热涂料等。若加热装置3012为加热电阻时,加热电阻布局在惯性传感器的相邻位置,其数量为预设数量阈值,以确保加热电阻以最大功率加热惯性传感器时,惯性传感器的升温速率大于预设加热速率。在某些实施例中,惯性测量单元3011可以包括加速度计和陀螺仪。Please refer to FIG. 3, which is a schematic structural diagram of an unmanned control system according to an embodiment of the present invention. As shown in FIG. 3, the unmanned control system 30 is composed of an unmanned control robot 301 and a control terminal 302. Among them, the unmanned robot 301 includes an inertial sensor 3011 and a heating device 3012. The control terminal 302 is used to control the unmanned robot to move. The inertial sensor 3011 is a sensor that measures acceleration, tilt, impact, vibration, rotation, and multi-degree-of-freedom motion, and is used to output sensor data. The heating device 3012 is used to heat the inertial sensor 3011, and the heating device 3012 can be a heating resistor, a ceramic heating sheet, or an electric heating paint. If the heating device 3012 is a heating resistor, the heating resistors are arranged adjacent to the inertial sensor, and their number is the preset number threshold to ensure that when the heating resistor heats the inertial sensor with the maximum power, the heating rate of the inertial sensor is greater than the preset heating rate . In some embodiments, the inertial measurement unit 3011 may include an accelerometer and a gyroscope.
以无人控制机器人为无人机为例,图4为无人机执行任务时的一个应用场景图,A点为无人机被启动时所处的位置,B点为无人机需要执行任务时的任务位置点,无人机在任务位置B点需要执行预设任务,如对图中的人物进行拍照、摄影等。无人机在A点时被启动时,无人机响应于开机信号,控制加热装置将惯性传感器加热至工作温度。无人机在预设时间内将惯性传感器加热至工作温度,于是无人机在A点获取惯性传感器的传感数据和工作温度下的零偏参数,并根据工作温度下的零偏参数对传感数据进行补偿,获得补偿后的传感数据。最后根据补偿后的传感数据对无人机进行定位操作。若在A点,惯性传感器被加热至工作温度,则响应无人机的控制终端的运动控制指令,向B点运动。该方法中,惯性传感器的温度达到了工作温度,只需在工作温度下,根据该工作温度对应的零偏参数对惯性传感器输出的传感数据进行补偿,在后续的运动和执行任务过程中,不需要根据惯性传感器的其他温度对应的零偏参数对惯性传感器输出的传感数据进行补偿,可降低惯性传感器的标定和生产成本。Taking the unmanned robot as an example of a drone, Figure 4 is an application scenario diagram when the drone is performing a task. Point A is the position of the drone when it is started, and point B is the task that the drone needs to perform. At the task location point at the time, the drone needs to perform preset tasks at the task location B, such as taking photos and photography of the characters in the picture. When the drone is activated at point A, the drone responds to the power-on signal and controls the heating device to heat the inertial sensor to the working temperature. The drone heats the inertial sensor to the working temperature within the preset time, so the drone obtains the sensing data of the inertial sensor and the zero offset parameter at the working temperature at point A, and transmits it according to the zero offset parameter at the working temperature. Sensing data is compensated, and the compensated sensing data is obtained. Finally, the UAV is positioned according to the compensated sensor data. If at point A, the inertial sensor is heated to the working temperature, it will move to point B in response to the motion control instruction of the control terminal of the drone. In this method, the temperature of the inertial sensor reaches the working temperature, and it only needs to compensate the sensor data output by the inertial sensor according to the zero offset parameter corresponding to the working temperature at the working temperature. In the subsequent movement and task execution process, There is no need to compensate the sensor data output by the inertial sensor according to the zero offset parameters corresponding to other temperatures of the inertial sensor, which can reduce the calibration and production costs of the inertial sensor.
基于上述描述,本发明实施例提出一种如图5所示的无人控制机器人的惯性传感器加热方法,该无人控制机器人的惯性传感器加热方法可以包括S501-S506:Based on the foregoing description, an embodiment of the present invention proposes an inertial sensor heating method for an unmanned robot as shown in FIG. 5, and the inertial sensor heating method for an unmanned robot may include S501-S506:
S501:无人控制机器人按照加热装置的最大加热功率,控制加热装置将惯性传感器加热至低于工作温度的参考温度。S501: The unmanned robot controls the heating device to heat the inertial sensor to a reference temperature lower than the operating temperature according to the maximum heating power of the heating device.
具体的,当无人控制机器人被开启时,无人控制机器人响应于所述无人控制机器人的开机信号,按照加热装置的最大加热功率,控制加热装置将惯性传感器加热至低于工作温度的参考温度。Specifically, when the unmanned robot is turned on, the unmanned robot responds to the power-on signal of the unmanned robot and controls the heating device to heat the inertial sensor to a reference value lower than the operating temperature according to the maximum heating power of the heating device. temperature.
其中,加热装置可以为加热电阻、陶瓷发热片或电热涂料等,若加热装置为加热电阻时,加热电阻预先布局在惯性传感器的相邻位置,其数量大于预设数量阈值,以确保加热电阻以最大功率加热惯性传感器时,惯性传感器的升温速率不低于预设加热速率,示例性的,预设加热速率可以大于或等于5度/秒。惯性传感器的工作温度高于无人控制机器人所处的环境温度,工作温度可以在60-90度之间。在一种实现方式中,工作温度是用户根据无人控制机器人能够 正常工作的最高环境温度设定的。例如,无人控制机器人能够正常工作的最高环境温度为60度,用户根据此温度设定所述无人控制机器人的工作温度为75度。Among them, the heating device can be a heating resistor, a ceramic heating sheet, or an electric heating paint. If the heating device is a heating resistor, the heating resistor is pre-arranged in the adjacent position of the inertial sensor, and its number is greater than the preset number threshold to ensure that the heating resistance is When the inertial sensor is heated with the maximum power, the heating rate of the inertial sensor is not lower than the preset heating rate. For example, the preset heating rate may be greater than or equal to 5 degrees per second. The working temperature of the inertial sensor is higher than the ambient temperature where the unmanned robot is located, and the working temperature can be between 60-90 degrees. In one implementation, the working temperature is set by the user according to the highest ambient temperature at which the unmanned robot can work normally. For example, the maximum ambient temperature at which the unmanned robot can work normally is 60 degrees, and the user sets the operating temperature of the unmanned robot to 75 degrees according to this temperature.
参考温度可以是根据工作温度设定,参考温度接近工作温度且低于工作温度。例如,参考温度和工作温度之间的比值为x,n<x<1,例如n可以为0.8,0.9或0.95,等等,x可使得参考温度尽量接近工作温度。又如,工作温度和参考温度之间的差值小于预设阈值,预设阈值可以为10度或者5度,等等,预设阈值可使得参考温度尽量接近工作温度。The reference temperature may be set according to the working temperature, and the reference temperature is close to and lower than the working temperature. For example, the ratio between the reference temperature and the working temperature is x, n<x<1, for example, n can be 0.8, 0.9, or 0.95, etc., x can make the reference temperature as close to the working temperature as possible. For another example, the difference between the operating temperature and the reference temperature is less than a preset threshold, the preset threshold may be 10 degrees or 5 degrees, etc. The preset threshold can make the reference temperature as close to the operating temperature as possible.
在一种实现方式中,当无人控制机器人被用户开启时,无人控制机器人响应于所述无人控制机器人的开机信号,输入满占空比的脉冲调制电压,以使无人控制机器人按照加热装置的最大加热功率,控制加热装置将惯性传感器加热至参考温度。In one implementation, when the unmanned robot is turned on by the user, the unmanned robot responds to the power-on signal of the unmanned robot and inputs a pulse modulation voltage with a full duty cycle, so that the unmanned robot will follow The maximum heating power of the heating device controls the heating device to heat the inertial sensor to the reference temperature.
在一种实现方式中,无人控制机器人按照加热装置的最大功率,控制惯性传感器进行加热时,惯性传感器至少以不低于预设加热速率升高温度,预设加热速率大于或等于5度/秒,预设加热速率远高于目前的惯性传感器的加热速率。此预设加热速率可确保快速地将惯性传感器的温度加热至工作温度。In one implementation mode, when the unmanned robot controls the inertial sensor to heat according to the maximum power of the heating device, the inertial sensor increases the temperature at least at a preset heating rate, and the preset heating rate is greater than or equal to 5 degrees/ Seconds, the preset heating rate is much higher than the current heating rate of inertial sensors. This preset heating rate can ensure that the temperature of the inertial sensor is quickly heated to the working temperature.
在一种实现方式中,无人控制机器人按照加热装置的最大加热功率,控制加热装置在预设时间内,将惯性传感器加热至工作温度,所述预设时间不大于30秒,以使惯性传感器快速地达到工作温度之后,不需要根据惯性传感器的其他温度对应的零偏参数对惯性传感器输出的传感数据进行补偿,可降低惯性传感器的标定成本。In one implementation, the unmanned robot controls the heating device to heat the inertial sensor to the working temperature within a preset time according to the maximum heating power of the heating device, and the preset time is not more than 30 seconds, so that the inertial sensor After the operating temperature is reached quickly, there is no need to compensate the sensor data output by the inertial sensor according to the zero offset parameters corresponding to other temperatures of the inertial sensor, which can reduce the calibration cost of the inertial sensor.
S502:当确定惯性传感器被加热至参考温度时,无人控制机器人采用闭环加热控制策略控制加热装置将惯性传感器加热至工作温度。S502: When it is determined that the inertial sensor is heated to the reference temperature, the unmanned robot adopts a closed-loop heating control strategy to control the heating device to heat the inertial sensor to the working temperature.
为避免惯性传感器的温度按照S501方法上升时,超过惯性传感器的工作温度,则无人控制机器人确定惯性传感器被加热至参考温度时,采用闭环加热控制策略控制加热装置将惯性传感器加热至工作温度。In order to prevent the temperature of the inertial sensor from exceeding the operating temperature of the inertial sensor when it rises according to the S501 method, when the unmanned robot determines that the inertial sensor is heated to the reference temperature, the closed-loop heating control strategy is adopted to control the heating device to heat the inertial sensor to the operating temperature.
具体的,闭环加热控制策略包括PI控制策略,PI控制策略包括线性控制参数和积分控制参数,线性控制参数用于调整控制系统的稳定性,积分控制参数用于调整控制系统的无差度。当确定惯性传感器被加热至参考温度时,无人 控制机器人调整PI控制策略的线性控制参数和积分控制参数,使得惯性传感器在不超过工作温度的前提下,在参考温度和工作温度之间上升,直至达到工作温度。Specifically, the closed-loop heating control strategy includes a PI control strategy. The PI control strategy includes linear control parameters and integral control parameters. The linear control parameters are used to adjust the stability of the control system, and the integral control parameters are used to adjust the indifference of the control system. When it is determined that the inertial sensor is heated to the reference temperature, the unmanned control robot adjusts the linear control parameters and integral control parameters of the PI control strategy, so that the inertial sensor rises between the reference temperature and the operating temperature without exceeding the operating temperature. Until the operating temperature is reached.
在一种实现方式中,无人控制机器人确定惯性传感器的温度达到工作温度时,调整PI控制策略的积分控制参数,使得惯性传感器的温度稳定在工作温度,确保惯性传感器在后续的工作过程中,其温度保持在工作温度不变。In one implementation, when the unmanned robot determines that the temperature of the inertial sensor reaches the working temperature, it adjusts the integral control parameters of the PI control strategy to stabilize the temperature of the inertial sensor at the working temperature, ensuring that the inertial sensor is in the subsequent working process. Its temperature remains unchanged at the working temperature.
以惯性传感器的工作温度为65度为例,本方法下的惯性传感器的升温曲线和传统方法下的惯性传感器的升温曲线如图6所示,本方法为相对传统方法的改进方法,即本申请实施例公开的技术方案。可以看出,相对于传统方法,在改进的加热方法下,惯性传感器的温度在上电后20秒左右上升至工作温度,并保持工作温度稳定,而传统方法下的惯性传感器的温度在上电后20秒仍未达到工作温度。本方法下的惯性传感器的升温速率明显大于传统方法下的升温速率,使得惯性传感器的温度能快速上升至参考温度,并在闭环控制策略下,上升至工作温度,且到达工作温度后,恒定在工作温度。Taking the working temperature of the inertial sensor as an example of 65 degrees, the heating curve of the inertial sensor under this method and the heating curve of the inertial sensor under the traditional method are shown in Fig. 6. This method is an improved method relative to the traditional method, that is, this application The technical solutions disclosed in the embodiments. It can be seen that, compared with the traditional method, under the improved heating method, the temperature of the inertial sensor rises to the working temperature about 20 seconds after power-on and keeps the working temperature stable, while the temperature of the inertial sensor under the traditional method is on the power-up. The working temperature has not been reached after 20 seconds. The heating rate of the inertial sensor under this method is obviously greater than that under the traditional method, so that the temperature of the inertial sensor can quickly rise to the reference temperature, and under the closed-loop control strategy, it rises to the working temperature, and after reaching the working temperature, it is constant at Operating temperature.
S503:无人控制机器人获取惯性传感器在工作温度输出的传感数据。S503: The unmanned robot obtains the sensing data output by the inertial sensor at the working temperature.
当确定惯性传感器的温度上升至工作温度之后,无人控制机器人获取惯性传感器在工作温度输出的传感数据,传感数据可以包括无人控制机器人的姿态,其姿态包括角速度和加速度等。惯性传感器在工作温度输出的传感数据,存在零偏,不能直接作为惯性传感器测量的传感数据,需要根据工作温度下的零偏参数对传感数据进行补偿。When it is determined that the temperature of the inertial sensor rises to the working temperature, the unmanned control robot obtains the sensing data output by the inertial sensor at the working temperature. The sensing data can include the attitude of the unmanned control robot, which includes angular velocity and acceleration. The sensing data output by the inertial sensor at the working temperature has zero bias, which cannot be directly used as the sensing data measured by the inertial sensor. The sensing data needs to be compensated according to the zero bias parameters at the working temperature.
S504:无人控制机器人在本地存储装置中,获取惯性传感器在工作温度的零偏参数。S504: The unmanned robot obtains the zero offset parameter of the inertial sensor at the working temperature in the local storage device.
惯性传感器的测量会存在零偏,其零偏与温度有关,因此需要在惯性传感器的工作温度下,根据该温度下的零偏参数对传感数据进行补偿。因此需要提前在无人控制机器人的本地存储装置中,获取惯性传感器在工作温度的零偏参数。其中,所述本地存储装置中不存储除所述工作温度之外的其他温度的零偏参数,即无人控制机器人不需要提前存储其他温度点对应的零偏参数,可减少惯性传感器的标定成本。The measurement of inertial sensors will have a zero offset, and the zero offset is related to temperature. Therefore, it is necessary to compensate the sensor data according to the zero offset parameters at the operating temperature of the inertial sensor. Therefore, it is necessary to obtain the zero offset parameters of the inertial sensor at the working temperature in the local storage device of the unmanned robot in advance. Wherein, the local storage device does not store the zero offset parameters of other temperatures other than the operating temperature, that is, the unmanned robot does not need to store the zero offset parameters corresponding to other temperature points in advance, which can reduce the calibration cost of the inertial sensor .
在一种实现方式中,惯性传感器在工作温度的零偏参数是工厂在生产惯性传感器时,对惯性传感器进行测量得到的。工作温度是用户对惯性传感器设定之后,将所述工作温度发送给工厂的。In an implementation manner, the zero offset parameter of the inertial sensor at the working temperature is obtained by measuring the inertial sensor when the factory produces the inertial sensor. The working temperature is sent to the factory after the user sets the inertial sensor.
在一种实现方式中,惯性传感器的零偏参数是无人控制机器人根据预设补偿参数获取算法和工作温度,对惯性传感器进行测量得到的,其中预设补偿参数算法包括小波变换、最小二乘法、灰色预测法等,在此不做限制。In one implementation, the zero-bias parameter of the inertial sensor is obtained by the unmanned robot according to the preset compensation parameter acquisition algorithm and operating temperature, and the inertial sensor is measured. The preset compensation parameter algorithm includes wavelet transform and least square method. , Gray forecasting method, etc., there are no restrictions here.
S505:无人控制机器人根据零偏参数对传感数据进行补偿,以获取补偿后的传感数据。S505: The unmanned robot compensates the sensor data according to the zero offset parameter to obtain the compensated sensor data.
无人控制机器人获得的惯性传感器在工作温度下的传感数据存在零偏,根据工作温度下的零偏参数对传感数据进行补偿,可以获得补偿后的传感数据,该补偿后的传感数据为更精准的传感数据。The inertial sensor obtained by the unmanned robot has zero bias in the sensing data at the working temperature. The sensor data is compensated according to the zero bias parameters at the working temperature, and the compensated sensing data can be obtained. The compensated sensing data The data is more accurate sensor data.
S506:无人控制机器人根据补偿后的传感数据,对无人控制机器人进行定位操作。S506: The unmanned robot performs positioning operations on the unmanned robot according to the compensated sensor data.
无人控制机器人获得补偿后的传感数据后,根据此补偿后的传感数据,对无人控制机器人进行定位操作。After the unmanned control robot obtains the compensated sensor data, it performs positioning operations on the unmanned control robot according to the compensated sensor data.
以惯性传感器的工作温度为65度为例,本方法与传统方法下的惯性传感器的零偏变化曲线如图7所示,本方法为传统方法下的改进方法。从图中可以看出,在上电后的20秒,改进方法下的加速度计零偏已经基本稳定,而传统方法下的零偏仍然在变化。Taking the operating temperature of the inertial sensor as an example of 65 degrees, the zero-bias change curve of the inertial sensor under this method and the traditional method is shown in Figure 7. This method is an improved method under the traditional method. It can be seen from the figure that, 20 seconds after power-on, the accelerometer zero bias under the improved method has been basically stable, while the zero bias under the traditional method is still changing.
在某些实施例中,当所述惯性传感器未被加热至所述工作温度时,拒绝响应控制终端发送的运动控制指令。具体地,当所述惯性传感器未被加热至所述工作温度,由于所述本地存储装置中不存储除所述工作温度之外的其他温度的零偏参数,即本地存储装置中仅存储在所述工作温度的零偏参数,惯性传感器输出的传感数据没有经过补偿,导致无人控制控制机器人定位不准确,因此,拒绝响应控制终端发送的运动控制指令以保证操作安全。In some embodiments, when the inertial sensor is not heated to the operating temperature, it refuses to respond to the motion control instruction sent by the control terminal. Specifically, when the inertial sensor is not heated to the operating temperature, since the local storage device does not store the zero offset parameters of other temperatures except the operating temperature, that is, the local storage device only stores the zero offset parameters at all temperatures. For the zero offset parameters of the working temperature, the sensing data output by the inertial sensor has not been compensated, resulting in inaccurate positioning of the unmanned control robot. Therefore, it refuses to respond to the motion control instructions sent by the control terminal to ensure safe operation.
采用本实施例,无人控制机器人可控制加热装置在预设时间内,将惯性传感器加热至工作温度,使得无人控制机器人只需针对惯性传感器的一个工作温度输出的传感数据进行补偿,可提高惯性传感器的测量精度。同时,也使得无 人控制机器人的本地存储只存储惯性传感器在工作温度下对应的零偏参数,可减少惯性传感器的标定和生产成本。Using this embodiment, the unmanned control robot can control the heating device to heat the inertial sensor to the working temperature within a preset time, so that the unmanned control robot only needs to compensate for the sensing data output by one working temperature of the inertial sensor. Improve the measurement accuracy of inertial sensors. At the same time, the local storage of the unmanned control robot only stores the zero offset parameters of the inertial sensor at the working temperature, which can reduce the calibration and production costs of the inertial sensor.
本发明实施例提供一种无人控制机器人,图8是本发明实施例提供的一种无人控制机器人的结构示意图。如图8所示,无人控制机器人80包括存储器801、处理器802、惯性传感器803以及加热装置804,其中,存储器801包括本地存储装置,本地存储装置用于存储惯性传感器803在工作温度下的零偏参数,存储器801中存储有程序代码,处理器802调用存储器801中的程序代码,当程序代码被执行时,处理器802执行如下操作:An embodiment of the present invention provides an unmanned control robot, and FIG. 8 is a schematic structural diagram of an unmanned control robot provided in an embodiment of the present invention. As shown in FIG. 8, the unmanned robot 80 includes a memory 801, a processor 802, an inertial sensor 803, and a heating device 804. The memory 801 includes a local storage device, and the local storage device is used to store the inertial sensor 803 at a working temperature. For zero offset parameters, the memory 801 stores program codes, and the processor 802 calls the program codes in the memory 801. When the program codes are executed, the processor 802 performs the following operations:
控制加热装置804将惯性传感器803加热至工作温度;获取惯性传感器803在工作温度输出的传感数据;从无人控制机器人的存储器801包括的本地存储装置中,获取惯性传感器803在工作温度的零偏参数,其中,本地存储装置中不存储除工作温度之外的其他温度的零偏参数;根据零偏参数对传感数据进行补偿,以获取补偿后的传感数据;根据补偿后的传感数据,对无人控制机器人进行定位操作。Control the heating device 804 to heat the inertial sensor 803 to the working temperature; obtain the sensor data output by the inertial sensor 803 at the working temperature; obtain the zero value of the inertial sensor 803 at the working temperature from the local storage device included in the memory 801 of the unmanned robot Bias parameters, where the local storage device does not store the zero bias parameters of other temperatures except the operating temperature; the sensor data is compensated according to the zero bias parameters to obtain the compensated sensor data; according to the compensated sensor Data, positioning operation of the unmanned robot.
可选的,所述处理器802控制加热装置804将惯性传感器803加热至工作温度时,工作温度高于无人控制机器人的环境温度。Optionally, when the processor 802 controls the heating device 804 to heat the inertial sensor 803 to a working temperature, the working temperature is higher than the ambient temperature of the unmanned robot.
可选的,所述处理器802控制加热装置804将惯性传感器803加热至工作温度时,工作温度在60-90度之间。Optionally, when the processor 802 controls the heating device 804 to heat the inertial sensor 803 to a working temperature, the working temperature is between 60-90 degrees.
可选的,所述处理器802控制加热装置804将惯性传感器803加热至工作温度的工作温度,具体用于:Optionally, the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature of the working temperature, specifically for:
所述处理器802响应于无人控制机器人的开机信号,控制加热装置804将惯性传感器803加热至工作温度。In response to the power-on signal of the unmanned robot, the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature.
可选的,所述处理器802控制加热装置804将惯性传感器803加热至工作温度的工作温度时,加热装置804为加热电阻。Optionally, when the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature of the working temperature, the heating device 804 is a heating resistor.
可选的,所述处理器802控制加热装置804将惯性传感器803加热至工作温度的工作温度,具体用于:Optionally, the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature of the working temperature, specifically for:
所述处理器802控制加热装置804在预设时间内将惯性传感器803加热至工作温度。The processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature within a preset time.
可选的,所述处理器802控制加热装置804在预设时间内将惯性传感器803加热至工作温度时,预设时间不大于30秒。Optionally, when the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature within a preset time, the preset time is not more than 30 seconds.
可选的,所述处理器802控制加热装置804将惯性传感器803加热至工作温度的工作温度,具体用于:Optionally, the processor 802 controls the heating device 804 to heat the inertial sensor 803 to the working temperature of the working temperature, specifically for:
所述处理器802按照加热装置804的最大加热功率,控制加热装置804将惯性传感器803加热至低于工作温度的参考温度;The processor 802 controls the heating device 804 to heat the inertial sensor 803 to a reference temperature lower than the operating temperature according to the maximum heating power of the heating device 804;
当所述处理器802确定惯性传感器803被加热至参考温度时,采用闭环加热控制策略控制加热装置804将惯性传感器803加热至工作温度。When the processor 802 determines that the inertial sensor 803 is heated to the reference temperature, a closed-loop heating control strategy is adopted to control the heating device 804 to heat the inertial sensor 803 to the working temperature.
可选的,当所述处理器802确定惯性传感器803被加热至参考温度时,采用闭环加热控制策略控制加热装置804将惯性传感器803加热至工作温度时,闭环加热控制策略包括PI控制策略。Optionally, when the processor 802 determines that the inertial sensor 803 is heated to the reference temperature, and adopts a closed-loop heating control strategy to control the heating device 804 to heat the inertial sensor 803 to the working temperature, the closed-loop heating control strategy includes a PI control strategy.
可选的,所述处理器802控制加热装置804以最大功率对惯性传感器803进行加热时,惯性传感器803至少以不低于预设加热速率升高温度。Optionally, when the processor 802 controls the heating device 804 to heat the inertial sensor 803 with the maximum power, the inertial sensor 803 at least increases the temperature at a heating rate not lower than a preset heating rate.
可选的,所述处理器802控制加热装置804以最大功率对惯性传感器803进行加热时,惯性传感器804至少以不低于预设加热速率升高温度时,预设加热速率大于或等于5度/秒。Optionally, when the processor 802 controls the heating device 804 to heat the inertial sensor 803 with the maximum power, the preset heating rate is greater than or equal to 5 degrees when the inertial sensor 804 increases the temperature at least at a preset heating rate. /second.
可选的,当所述处理器802在所述惯性传感器未被加热至所述工作温度时,拒绝响应控制终端发送的运动控制指令。Optionally, when the inertial sensor is not heated to the operating temperature, the processor 802 refuses to respond to the motion control instruction sent by the control terminal.
在本发明实施例中,处理器802可控制加热装置804在预设时间内,将惯性传感器803加热至工作温度,使得处理器802只需针对惯性传感器803的一个工作温度输出的传感数据进行补偿,可提高惯性传感器803的测量精度。同时,也使得存储器801只存储惯性传感器803在工作温度下对应的零偏参数,可减少惯性传感器803的生产成本。In the embodiment of the present invention, the processor 802 can control the heating device 804 to heat the inertial sensor 803 to the operating temperature within a preset time, so that the processor 802 only needs to perform sensing data output from one operating temperature of the inertial sensor 803. Compensation can improve the measurement accuracy of the inertial sensor 803. At the same time, the memory 801 only stores the zero offset parameters corresponding to the inertial sensor 803 at the working temperature, which can reduce the production cost of the inertial sensor 803.
本发明实施例还提供一种无人控制机器人系统,该无人控制机器人系统包括:The embodiment of the present invention also provides an unmanned control robot system, the unmanned control robot system includes:
上述实施例提供的所述无人控制机器人;The unmanned control robot provided in the foregoing embodiment;
以及控制终端,用于响应用户的控制操作,并对所述无人机控制机器人进行控制。And the control terminal is used to respond to the user's control operation and control the drone control robot.
可选地,所述无人控制机器人至少包括如下的一种:无人机、无人驾驶汽车、无人船。Optionally, the unmanned control robot includes at least one of the following: unmanned aerial vehicles, unmanned vehicles, and unmanned ships.
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以所述权利要求的保护范围为准。The above are only specific embodiments of the present invention, but the scope of protection of the present invention is not limited thereto. Any person skilled in the art can easily think of changes or substitutions within the technical scope disclosed by the present invention. It should be covered within the protection scope of the present invention. Therefore, the protection scope of the present invention should be subject to the protection scope of the claims.

Claims (26)

  1. 一种无人控制机器人的惯性传感器加热方法,其中,所述无人控制机器人包括所述惯性传感器和用于对所述惯性传感器进行加热的加热装置,其特征在于,包括:An inertial sensor heating method of an unmanned robot, wherein the unmanned robot includes the inertial sensor and a heating device for heating the inertial sensor, characterized in that it comprises:
    控制所述加热装置将所述惯性传感器加热至工作温度;Controlling the heating device to heat the inertial sensor to a working temperature;
    获取所述惯性传感器在所述工作温度输出的传感数据;Acquiring sensor data output by the inertial sensor at the operating temperature;
    从所述无人控制机器人的本地存储装置中,获取所述惯性传感器在所述工作温度的零偏参数,其中,所述本地存储装置中不存储除所述工作温度之外的其他温度的零偏参数;Obtain the zero-bias parameters of the inertial sensor at the working temperature from the local storage device of the unmanned robot, wherein the local storage device does not store zero values of other temperatures except the working temperature. Partial parameter
    根据所述零偏参数对所述传感数据进行补偿,以获取补偿后的传感数据;Compensate the sensor data according to the zero-bias parameter to obtain compensated sensor data;
    根据所述补偿后的传感数据,对所述无人控制机器人进行定位操作。Perform a positioning operation on the unmanned robot according to the compensated sensor data.
  2. 根据权利要求1所述的方法,其特征在于,所述工作温度高于所述无人控制机器人所处的环境温度。The method according to claim 1, wherein the working temperature is higher than the temperature of the environment where the unmanned robot is located.
  3. 根据权利要求2所述的方法,其特征在于,所述工作温度位于在60-90度之间。The method according to claim 2, wherein the operating temperature is between 60-90 degrees.
  4. 根据权利要求1-3任一项所述的方法,其特征在于,所述控制所述加热装置将所述惯性传感器加热至工作温度,包括:The method according to any one of claims 1 to 3, wherein the controlling the heating device to heat the inertial sensor to a working temperature comprises:
    响应于所述无人控制机器人的开机信号,控制所述加热装置将所述惯性传感器加热至所述工作温度。In response to the power-on signal of the unmanned robot, the heating device is controlled to heat the inertial sensor to the working temperature.
  5. 根据权利要求1-4任一项所述的方法,其特征在于,所述加热装置为加热电阻。The method according to any one of claims 1 to 4, wherein the heating device is a heating resistor.
  6. 根据权利要求1-5任一项所述方法,其特征在于,所述控制所述加热装置将所述惯性传感器加热至工作温度,包括:The method according to any one of claims 1 to 5, wherein the controlling the heating device to heat the inertial sensor to a working temperature comprises:
    控制所述加热装置在预设时间内将所述惯性传感器加热至所述工作温度。The heating device is controlled to heat the inertial sensor to the operating temperature within a preset time.
  7. 根据权利要求6所述的方法,其特征在于,所述预设时间不大于30秒。The method according to claim 6, wherein the preset time is not more than 30 seconds.
  8. 根据权利要求1-7任一项所述的方法,其特征在于,所述控制所述加热装置将所述惯性传感器加热至工作温度,包括:The method according to any one of claims 1-7, wherein the controlling the heating device to heat the inertial sensor to a working temperature comprises:
    按照所述加热装置的最大加热功率,控制所述加热装置将所述惯性传感器加热至低于所述工作温度的参考温度;According to the maximum heating power of the heating device, controlling the heating device to heat the inertial sensor to a reference temperature lower than the operating temperature;
    当确定所述惯性传感器被加热至所述参考温度时,采用闭环加热控制策略控制所述加热装置将所述惯性传感器加热至所述工作温度。When it is determined that the inertial sensor is heated to the reference temperature, a closed-loop heating control strategy is adopted to control the heating device to heat the inertial sensor to the operating temperature.
  9. 根据权利要求8所述的方法,其特征在于,所述闭环加热控制策略包括PI控制策略。The method according to claim 8, wherein the closed-loop heating control strategy comprises a PI control strategy.
  10. 根据权利要求8或9所述的方法,其特征在于,所述加热装置以最大功率对所述惯性传感器进行加热时,所述惯性传感器至少以不低于预设加热速率升高温度。The method according to claim 8 or 9, wherein when the heating device heats the inertial sensor with the maximum power, the inertial sensor at least raises the temperature at a heating rate not lower than a preset heating rate.
  11. 根据权利要求10所述的方法,其特征在于,所述预设加热速率大于或等于5度/秒。The method according to claim 10, wherein the preset heating rate is greater than or equal to 5 degrees per second.
  12. 根据权利要求1-11任一项所述的方法,其特征在于,所述方法还包括:当所述惯性传感器未被加热至所述工作温度时,拒绝响应控制终端发送的运动控制指令。The method according to any one of claims 1-11, wherein the method further comprises: when the inertial sensor is not heated to the operating temperature, refusing to respond to the motion control instruction sent by the control terminal.
  13. 一种无人控制机器人,其特征在于,包括存储器、处理器、惯性传感器以及加热装置;An unmanned robot, which is characterized by comprising a memory, a processor, an inertial sensor and a heating device;
    所述存储器存储程序代码;The memory stores program codes;
    所述处理器,调用所述程序代码,当程序代码被执行时,用于执行以下操作:The processor calls the program code, and when the program code is executed, is used to perform the following operations:
    控制所述加热装置将所述惯性传感器加热至工作温度;Controlling the heating device to heat the inertial sensor to a working temperature;
    获取所述惯性传感器在所述工作温度输出的传感数据;Acquiring sensor data output by the inertial sensor at the operating temperature;
    从所述无人控制机器人的本地存储装置中,获取所述惯性传感器在所述工作温度的零偏参数,其中,所述存储器包括的本地存储装置中不存储除所述工作温度之外的其他温度的零偏参数;Obtain the zero-bias parameters of the inertial sensor at the operating temperature from the local storage device of the unmanned robot, wherein the local storage device included in the memory does not store anything other than the operating temperature Bias parameter of temperature;
    根据所述零偏参数对所述传感数据进行补偿,以获取补偿后的传感数据;Compensate the sensor data according to the zero-bias parameter to obtain compensated sensor data;
    根据所述补偿后的传感数据,对所述无人控制机器人进行定位操作。According to the compensated sensor data, a positioning operation is performed on the unmanned robot.
  14. 根据权利要求13所述的无人控制机器人,其特征在于,所述工作温度高于所述无人控制机器人所处的环境温度。The unmanned robot according to claim 13, wherein the working temperature is higher than the temperature of the environment where the unmanned robot is located.
  15. 根据权利要求14所述的无人控制机器人,其特征在于,所述工作温度在60-90度之间。The unmanned robot according to claim 14, wherein the working temperature is between 60-90 degrees.
  16. 根据权利要求13-15任一项所述的无人控制机器人,其特征在于,所述控制所述加热装置将所述惯性传感器加热至工作温度时,执行如下操作:The unmanned robot according to any one of claims 13-15, wherein when the heating device is controlled to heat the inertial sensor to a working temperature, the following operations are performed:
    响应于所述无人控制机器人的开机信号,控制所述加热装置将所述惯性传感器加热至所述工作温度。In response to the power-on signal of the unmanned robot, the heating device is controlled to heat the inertial sensor to the working temperature.
  17. 根据权利要求13-16任一项所述的无人控制机器人,其特征在于,所述加热装置为加热电阻。The unmanned robot according to any one of claims 13-16, wherein the heating device is a heating resistor.
  18. 根据权利要求13-17任一项所述的无人控制机器人,其特征在于,所述控制所述加热装置将所述惯性传感器加热至工作温度时,执行如下操作:The unmanned robot according to any one of claims 13-17, wherein when the heating device is controlled to heat the inertial sensor to a working temperature, the following operations are performed:
    控制所述加热装置在预设时间内将所述惯性传感器加热至所述工作温度。The heating device is controlled to heat the inertial sensor to the operating temperature within a preset time.
  19. 根据权利要求18所述的无人控制机器人,其特征在于,所述预设时间不大于30秒。The unmanned robot according to claim 18, wherein the preset time is not more than 30 seconds.
  20. 根据权利要求13-19任一项所述的无人控制机器人,其特征在于,所述控制所述加热装置将所述惯性传感器加热至工作温度时,执行如下操作:The unmanned robot according to any one of claims 13-19, wherein when the heating device is controlled to heat the inertial sensor to a working temperature, the following operations are performed:
    按照所述加热装置的最大加热功率控制所述加热装置将所述惯性传感器加热至低于所述工作温度的参考温度;Controlling the heating device to heat the inertial sensor to a reference temperature lower than the operating temperature according to the maximum heating power of the heating device;
    当确定所述惯性传感器被加热至所述参考温度时,采用闭环加热控制策略控制所述加热装置将所述惯性传感器加热至所述工作温度。When it is determined that the inertial sensor is heated to the reference temperature, a closed-loop heating control strategy is adopted to control the heating device to heat the inertial sensor to the operating temperature.
  21. 根据权利要求20所述的无人控制机器人,其特征在于,所述闭环加热控制策略包括PI控制策略。The unmanned robot according to claim 20, wherein the closed-loop heating control strategy comprises a PI control strategy.
  22. 根据权利要求19或20所述的无人控制机器人,其特征在于,所述加热装置以最大功率对所述惯性传感器进行加热时,所述惯性传感器至少以不低于预设加热速率升高温度。The unmanned robot according to claim 19 or 20, wherein when the heating device heats the inertial sensor with maximum power, the inertial sensor at least raises the temperature at a heating rate not lower than a preset heating rate. .
  23. 根据权利要求22所述的无人控制机器人,其特征在于,所述预设加热速率大于或等于5度/秒。The unmanned robot of claim 22, wherein the preset heating rate is greater than or equal to 5 degrees per second.
  24. 根据权利要求13-23任一项所述的无人控制机器人,其特征在于,所述处理器调用所述程序代码时,还执行如下操作:The unmanned robot according to any one of claims 13-23, wherein when the processor calls the program code, it also performs the following operations:
    当所述惯性传感器未被加热至所述工作温度时,拒绝响应控制终端发送的运动控制指令。When the inertial sensor is not heated to the operating temperature, it refuses to respond to the motion control instruction sent by the control terminal.
  25. 一种无人控制机器人系统,其特征在于,包括:An unmanned control robot system is characterized in that it comprises:
    如权利要求13-24任一项所述无人控制机器人;The unmanned robot according to any one of claims 13-24;
    控制终端,用于响应用户的控制操作,并对所述无人机控制机器人进行控制。The control terminal is used to respond to the user's control operation and control the drone control robot.
  26. 根据权利要求25所述的无人控制机器人系统,其特征在于,所述无人控制机器人至少包括如下的一种:无人机、无人驾驶汽车、无人船。The unmanned control robot system according to claim 25, wherein the unmanned control robot includes at least one of the following: unmanned aerial vehicles, unmanned vehicles, and unmanned ships.
PCT/CN2019/114135 2019-10-29 2019-10-29 Heating method for inertial sensor of unmanned robot WO2021081781A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201980007911.8A CN111656141A (en) 2019-10-29 2019-10-29 Heating method for inertial sensor of unmanned robot
PCT/CN2019/114135 WO2021081781A1 (en) 2019-10-29 2019-10-29 Heating method for inertial sensor of unmanned robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2019/114135 WO2021081781A1 (en) 2019-10-29 2019-10-29 Heating method for inertial sensor of unmanned robot

Publications (1)

Publication Number Publication Date
WO2021081781A1 true WO2021081781A1 (en) 2021-05-06

Family

ID=72351829

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/114135 WO2021081781A1 (en) 2019-10-29 2019-10-29 Heating method for inertial sensor of unmanned robot

Country Status (2)

Country Link
CN (1) CN111656141A (en)
WO (1) WO2021081781A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112629562A (en) * 2020-12-24 2021-04-09 广州导远电子科技有限公司 Assembly compensation method and device based on IMU sensor

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS563568B2 (en) * 1977-12-09 1981-01-26
US4901918A (en) * 1989-02-27 1990-02-20 Gas Research Institute Adaptive anticipator mechanism for limiting room temperature swings
CN205175415U (en) * 2015-10-30 2016-04-20 深圳市大疆创新科技有限公司 Inertia measuring unit and applied this inertia measuring unit's packaged plant
CN107003133A (en) * 2015-10-30 2017-08-01 深圳市大疆创新科技有限公司 The movable fixture of Inertial Measurement Unit and the application Inertial Measurement Unit
CN107533339A (en) * 2015-04-20 2018-01-02 深圳市大疆创新科技有限公司 System and method for sensor operations to be carried out with thermal conditioning
CN108286987A (en) * 2017-11-30 2018-07-17 深圳市科卫泰实业发展有限公司 A kind of unmanned plane flies the calibration method of control module MEMS motion sensors

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS563568B2 (en) * 1977-12-09 1981-01-26
US4901918A (en) * 1989-02-27 1990-02-20 Gas Research Institute Adaptive anticipator mechanism for limiting room temperature swings
CN107533339A (en) * 2015-04-20 2018-01-02 深圳市大疆创新科技有限公司 System and method for sensor operations to be carried out with thermal conditioning
CN205175415U (en) * 2015-10-30 2016-04-20 深圳市大疆创新科技有限公司 Inertia measuring unit and applied this inertia measuring unit's packaged plant
CN107003133A (en) * 2015-10-30 2017-08-01 深圳市大疆创新科技有限公司 The movable fixture of Inertial Measurement Unit and the application Inertial Measurement Unit
CN108286987A (en) * 2017-11-30 2018-07-17 深圳市科卫泰实业发展有限公司 A kind of unmanned plane flies the calibration method of control module MEMS motion sensors

Also Published As

Publication number Publication date
CN111656141A (en) 2020-09-11

Similar Documents

Publication Publication Date Title
US20170364077A1 (en) Unmanned aerial vehicle, motor control device and method
TWI654058B (en) Correction device, correction method and control device
US10513036B2 (en) Calibration system and calibration method
CN104811588B (en) A kind of boat-carrying based on gyroscope is surely as control method
CN111624941A (en) Unknown environment-oriented six-degree-of-freedom robot power control method
JP4650062B2 (en) Robot controller and robot positioning accuracy correction method
WO2021027638A1 (en) Yaw angle fusion method and apparatus, and aerial vehicle
JP2019532858A5 (en)
WO2019134154A1 (en) Control method for non-orthogonal tripod head, tripod head thereof, and storage device
WO2021037047A1 (en) Yaw angle correction method and apparatus for aircraft, and aircraft
US20210083617A1 (en) Gimbal and motor control method and device
WO2021016985A1 (en) Gimbal control method, controller, gimbal, unmanned mobile platform, and storage medium
WO2021081781A1 (en) Heating method for inertial sensor of unmanned robot
WO2020237493A1 (en) Zero calibration method for gimbal and gimbal
KR20170094851A (en) Calibration method for gyro sensor using tilt sensor
WO2019227464A1 (en) Rotation angle control method, pan-tilt device and computer-readable recording medium
US20210107146A1 (en) Gimbal control method and gimbal
TW202235204A (en) Spindle temperature measurement and compensation system and method
CN112857395A (en) Method and device for creating a correction value for correcting an inertial measurement unit of a vehicle
CN110871456B (en) Robot
CN114789439B (en) Slope positioning correction method, device, robot and readable storage medium
Wasilewski et al. Autocalibration of gyroscope based two-step regulator for autonomous vehicles.
CN111025908B (en) Attitude and heading reference system based on adaptive maneuvering acceleration extended Kalman filter
TR2021012920A2 (en) WIND SPEED AND DIRECTION MEASURING INSTRUMENT
Nam et al. Experimental study on the phase delay of low-cost IMU, low pass, and Kalman filter and its effect on the phase margin of angle estimation

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19950687

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19950687

Country of ref document: EP

Kind code of ref document: A1