WO2022183326A1 - Filtering method and apparatus, movable platform, and storage medium - Google Patents

Filtering method and apparatus, movable platform, and storage medium Download PDF

Info

Publication number
WO2022183326A1
WO2022183326A1 PCT/CN2021/078489 CN2021078489W WO2022183326A1 WO 2022183326 A1 WO2022183326 A1 WO 2022183326A1 CN 2021078489 W CN2021078489 W CN 2021078489W WO 2022183326 A1 WO2022183326 A1 WO 2022183326A1
Authority
WO
WIPO (PCT)
Prior art keywords
frequency
sensing signal
filter
energy
signal
Prior art date
Application number
PCT/CN2021/078489
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 PCT/CN2021/078489 priority Critical patent/WO2022183326A1/en
Publication of WO2022183326A1 publication Critical patent/WO2022183326A1/en

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04LTRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L25/00Baseband systems
    • H04L25/02Details ; arrangements for supplying electrical power along data transmission lines
    • H04L25/03Shaping networks in transmitter or receiver, e.g. adaptive shaping networks

Definitions

  • the present invention relates to the technical field of signal processing, and in particular, to a filtering method, device, movable platform and storage medium.
  • the rotating propeller When the UAV is hovering or flying forward, the rotating propeller will bring a series of vibration excitations.
  • the vibration excitation interacts with the UAV's flight control system and causes additional interference problems when the UAV is flying. , so that these vibration excitations will eventually affect the control performance of the flight control system.
  • a filter is used to filter out the energy of the interference signal generated by the vibration excitation.
  • the rationality of the filter design will directly affect the filtering effect, which in turn will affect the control performance of the flight control system.
  • Embodiments of the present invention provide a filtering method, a device, a movable platform and a storage medium, which are used to design a filter with high rationality to filter out the energy of interference signals generated by vibration excitation, thereby improving the control of the flight control system. performance.
  • an embodiment of the present invention provides a filtering method, which includes:
  • the sensing signal energy Based on the corresponding relationship between the sensing signal frequency and the sensing signal energy, determine the sensing signal energy corresponding to each of the multiple frequency multiplications, where the multiple frequency multiples refer to the sensing signal frequencies that are in multiple multiples of the rotation frequency of the motor;
  • the first filter corresponding to the frequency multiplier with the energy of the sensing signal greater than the corresponding threshold is turned on, and the second filter corresponding to the frequency multiplication with the energy of the sensory signal smaller than the corresponding threshold is turned off. device.
  • an embodiment of the present invention provides a filtering device, including a memory and a processor; wherein, executable code is stored on the memory, and when the executable code is executed by the processor, the processing is performed. implements:
  • the sensing signal energy Based on the corresponding relationship between the sensing signal frequency and the sensing signal energy, determine the sensing signal energy corresponding to each of the multiple frequency multiplications, where the multiple frequency multiples refer to the sensing signal frequencies that are in multiple multiples of the rotation frequency of the motor;
  • the first filter corresponding to the frequency multiplication with the energy of the sensing signal greater than the corresponding threshold is controlled to be turned on, and the first filter corresponding to the frequency multiplication with the energy of the sensing signal less than the corresponding threshold is controlled to be turned off.
  • an embodiment of the present invention provides a movable platform, including:
  • a power system arranged on the body, the power system is used to provide power for the movable platform;
  • the filtering device provided by the second aspect of the embodiment of the present invention, the filtering device is disposed on the body.
  • an embodiment of the present invention provides a computer-readable storage medium, where the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement the present invention
  • the filtering method provided by the first aspect of the embodiment.
  • the influence of a series of vibration excitations brought by the rotating propeller on the time-domain perception signal can be significantly reduced. If the energy of the perceptual signal corresponding to a certain octave is less than the threshold of the corresponding filter, the filter corresponding to the octave of which the energy of the perceptual signal is less than the corresponding threshold can be turned off, so that the filters that do not need to be used can be closed to the maximum extent, and then The phase margin of the controller can be guaranteed.
  • the filter corresponding to the octave whose energy of the perceptual signal is greater than the corresponding threshold can be turned on, so that the corresponding filter can be used to filter out the excess of the tolerance limit.
  • the energy of the sensing signal corresponding to a certain frequency multiplier and then it can ensure that the energy of the sensory signal corresponding to the frequency multiplication that does not reach the standard is filtered out, so as to ensure that the controller can exert the limit control performance.
  • the filter designed by the present invention has high rationality and can better filter out the interference signal energy generated by vibration excitation, thereby improving the control performance of the flight control system.
  • FIG. 1 is a schematic flowchart of a filtering method according to an embodiment of the present invention.
  • FIG. 2 is a schematic diagram of a first filter with a target depth that performs filtering processing on perceptual signal energy greater than a corresponding threshold according to an embodiment of the present invention
  • FIG. 3 is another schematic flowchart of a filtering method provided by an embodiment of the present invention.
  • FIG. 4 is a schematic structural diagram of a filtering device according to an embodiment of the present invention.
  • FIG. 5 is a schematic structural diagram of a movable platform according to an embodiment of the present invention.
  • the words “if”, “if” as used herein may be interpreted as “at” or “when” or “in response to determining” or “in response to detecting”.
  • the phrases “if determined” or “if detected (the stated condition or event)” can be interpreted as “when determined” or “in response to determining” or “when detected (the stated condition or event),” depending on the context )” or “in response to detection (a stated condition or event)”.
  • FIG. 1 is a flowchart of a filtering method provided by an embodiment of the present invention. As shown in FIG. 1 , the method includes the following steps:
  • the energy of the sensing signal corresponding to each of the multiple frequencies Based on the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal, determine the energy of the sensing signal corresponding to each of the multiple frequencies, where the multiple frequencies refer to the frequencies of the sensing signals that have multiple relationships with the rotation frequency of the motor.
  • the thresholds of the filters corresponding to the various frequency multipliers turn on the first filter corresponding to the frequency multiplier whose perceptual signal energy is greater than the corresponding threshold, and close the second filter corresponding to the multiplier whose perceptual signal energy is less than the corresponding threshold.
  • vibration excitation will act on some time-domain perception signals in the flight control system that are affected by the vibration of the UAV's propeller, which in turn will affect the accuracy of the time-domain perception signals, resulting in the flight control system based on low accuracy.
  • the time-domain perception signal is used for control with large error.
  • the above-mentioned time-domain perception signal affected by the vibration of the propeller of the drone may be, for example, an inertial measurement unit (Inertial Measurement Unit, IMU) detection signal or the like.
  • IMU Inertial Measurement Unit
  • the IMU signal can reflect the motion state of the drone body, and it is a time domain signal.
  • the process of acquiring the time-domain perception signal affected by the vibration of the propeller of the drone may be implemented as follows: acquiring the acquisition frequency of the time-domain perception signal affected by the vibration of the propeller of the drone; acquiring a preset acquisition duration; Set the time domain perception signal to be collected according to the collection frequency within the collection duration.
  • the time domain sensing signal may be collected within a preset collection duration according to the collection frequency, so that the time domain sensing signal includes a fixed number of values in the time domain. For example, if the time-domain perception signal is collected within 0.1s at a collection frequency of 2000Hz, 200 values can be collected.
  • the above collection duration can be set according to actual requirements. For example, it can be set according to the computing resources of the flight control system. When the computing resources of the flight control system are large, the acquisition duration can be appropriately increased, and when the computing resources of the flight control system are small, the acquisition duration can be appropriately reduced.
  • frequency domain transformation can be performed on the time domain sensing signal.
  • the frequency domain transformation processing of the time domain sensing signal the corresponding relationship between the sensing signal frequency and the sensing signal energy can be obtained.
  • the above-mentioned process of performing frequency domain transformation on the time domain sensing signal to obtain the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal may be implemented as follows: performing discrete Fourier transform on the sensing signal in the time domain to obtain the frequency of the sensing signal. Corresponding relationship with perceptual signal energy.
  • the rotation frequency of the motor of the drone can also be obtained, and the multiplier is a frequency that has a multiple relationship with the rotation frequency of the motor.
  • the rotation frequency of the motor is 200Hz
  • the double frequency is twice the rotation frequency of the motor, which is 200Hz
  • the double frequency is twice the rotation frequency of the motor, which is 400Hz
  • the triple frequency is three times the rotation frequency of the motor, which is 600Hz
  • the quadruple frequency is 400Hz.
  • the sixfold frequency is six times the motor rotation frequency, that is, 1200Hz.
  • the corresponding relationship between the sensing signal frequency and the sensing signal energy can be determined. There are multiple sensing signal frequencies in the corresponding relationship, and among the multiple sensing signal frequencies, there are frequencies that are multiples of the motor rotation frequency.
  • the perceptual signal energy corresponding to each of the multiple frequency multiplications can be determined based on the above-mentioned corresponding relationship.
  • the thresholds of the filters corresponding to various frequency doublings can be obtained. If a certain frequency multiplier does not exceed the threshold of the corresponding filter, it can be considered that the noise corresponding to the frequency multiplier is within the tolerance limit, and no filtering processing is required. If an octave exceeds the threshold of the corresponding filter, it can be considered that the noise corresponding to the octave has exceeded the tolerance limit and needs to be filtered.
  • special filters are provided for different frequency multiplications to perform filtering processing.
  • the first filter corresponding to the frequency multiplier whose perceptual signal energy is greater than the corresponding threshold value can be turned on, and the first filter corresponding to the frequency multiplication frequency whose perceptual signal energy is less than the corresponding threshold value can be turned off.
  • Second filter Second filter.
  • the thresholds of the filters corresponding to the various frequency multiplications may be preset. Specifically, the thresholds of filters corresponding to multiple frequency doublings may be set to the same value, or different filter thresholds may be set for different frequency doublings, which are not limited in this embodiment of the present invention.
  • the method provided by the embodiment of the present invention may further include: performing a filter on the energy of the sensing signal greater than the corresponding threshold through the first filter. Filter out processing.
  • the embodiment of the present invention does not limit the type of the filter, as long as the filter that can filter the energy of the sensing signal can be taken into consideration.
  • a notch filter may be used to filter out the perceptual signal energy.
  • the above-mentioned process of filtering out the perceptual signal energy greater than the corresponding threshold through the first filter can be implemented as follows: based on the perceptual signal energy greater than the corresponding threshold, the target depth of the first filter is determined; The first filter performs filtering processing on the perceptual signal energy greater than the corresponding threshold.
  • the notch filter has two filtering parameters, including width and depth.
  • the width of the notch filter is a fixed value, and the depth of the first filter can be adjusted according to the energy of the sensing signal greater than the corresponding threshold. In this way, the perceptual signal energy can be filtered by the first filter adapted to the perceptual signal energy greater than the corresponding threshold, and the obtained filtering effect is better.
  • the embodiment of the present invention provides a method for calculating the target depth of the first filter.
  • the above process of determining the target depth of the first filter based on the perceptual signal energy greater than the corresponding threshold may be implemented as: determining the reciprocal of the perceptual signal energy greater than the corresponding threshold as the target depth of the first filter.
  • the target depth of the first filter can be set to 1/5. Assuming that the perceptual signal energy greater than the corresponding threshold is 6, the target depth of the first filter can be set to 1/6.
  • FIG. 2 An exemplary illustration is given with reference to FIG. 2. As shown in the upper figure of FIG. Number of numeric IMU signals. Then, the discrete Fourier transform is performed on the IMU signal, as shown in the figure in Figure 2, to obtain the corresponding relationship between the frequency of the IMU signal and the energy of the IMU signal.
  • 100Hz is a double frequency and 200Hz is a double frequency.
  • the IMU signal energy corresponding to the double frequency is 6, and the IMU signal energy corresponding to the double frequency is also 6, and their corresponding filter thresholds Both are 4, then it is necessary to filter the IMU signal energy at frequency 1 and frequency 2.
  • the depth of the first notch filter used to filter out the energy of the IMU signal corresponding to the double frequency can be set to 1/6, and the depth of the second notch filter used to filter out the energy of the IMU signal corresponding to the double frequency is also Can be set to 1/6.
  • the corresponding relationship between the filtering frequency and the depth of the first notch filter and the second notch filter can be seen in the lower part of FIG. 2 .
  • the two waveforms are opposite to the abscissa axis.
  • the superposition result is close to or equal to 0, that is to say, the IMU signal energy corresponding to one frequency can be filtered out by the first notch filter and the second notch filter.
  • sliding window processing may be performed on the continuous time domain sensing signals in the time domain.
  • the sliding window processing may be to collect a period of time domain sensing signals within a preset collection period according to the collection frequency.
  • the discrete Fourier transform can be performed on the time-domain perception signal. It should be noted that since the rotating propeller will bring a series of vibration excitations, the vibration excitation will have an impact on the above-mentioned time-domain perception signal, so the object of the discrete Fourier transform is actually the time-domain perception signal and vibration excitation. the result of the interaction.
  • the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal can be obtained, and then the corresponding energy of the sensing signal can be determined based on the corresponding relationship. If the energy of the perceptual signal corresponding to a certain frequency is greater than the threshold of the corresponding filter, the first filter corresponding to the frequency of the frequency of which the energy of the perceptual signal is greater than the corresponding threshold is turned on. If the energy of the perceptual signal corresponding to a certain frequency is less than the threshold of the corresponding filter, the second filter corresponding to the frequency of which the energy of the perceptual signal is less than the corresponding threshold is turned off.
  • the influence of a series of vibration excitations brought by the rotating propeller on the time-domain perception signal can be significantly reduced. If the energy of the perceptual signal corresponding to a certain octave is less than the threshold of the corresponding filter, the filter corresponding to the octave of which the energy of the perceptual signal is less than the corresponding threshold can be turned off, so that the filters that do not need to be used can be closed to the maximum extent, and then The phase margin of the controller can be guaranteed.
  • the filter corresponding to the octave whose energy of the perceptual signal is greater than the corresponding threshold can be turned on, so that the corresponding filter can be used to filter out the excess of the tolerance limit.
  • the energy of the sensing signal corresponding to a certain frequency multiplier and then it can ensure that the energy of the sensory signal corresponding to the frequency multiplication that does not reach the standard is filtered out, so as to ensure that the controller can exert the limit control performance.
  • the filter designed by the present invention has high rationality and can better filter out the interference signal energy generated by vibration excitation, thereby improving the control performance of the flight control system.
  • Yet another exemplary embodiment of the present invention provides a filtering device, as shown in FIG. 4 , the device includes:
  • memory 1910 for storing computer programs
  • the processor 1920 is used for running the computer program stored in the memory 1910 to realize:
  • the perceptual signal energy corresponding to each of multiple frequency multiplications determines the perceptual signal energy corresponding to each of multiple frequency multiplications, and the multiple frequency multiplication refers to the perceptual signal frequency that is in a multiple multiple relationship with the rotation frequency of the motor;
  • the first filter corresponding to the frequency multiplication with the energy of the sensing signal greater than the corresponding threshold is controlled to be turned on, and the first filter corresponding to the frequency multiplication with the energy of the sensing signal less than the corresponding threshold is controlled to be turned off.
  • processor 1920 is further configured to:
  • the first filter is controlled to filter out the energy of the sensing signal greater than the corresponding threshold.
  • the filter is a notch filter.
  • the processor 1920 is configured to:
  • the first filter with the target depth is controlled to perform filtering processing on the perceptual signal energy greater than the corresponding threshold.
  • the processor 1920 is configured to:
  • the inverse of the perceptual signal energy greater than the corresponding threshold is determined as the target depth of the first filter.
  • the time-domain perception signal affected by the vibration of the propeller of the drone includes an inertial measurement unit detection signal.
  • the processor 1920 is configured to:
  • Discrete Fourier transform is performed on the time-domain sensing signal to obtain the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal.
  • the processor 1920 is configured to:
  • the time domain sensing signal is collected according to the collection frequency within the preset collection time period.
  • the filtering apparatus shown in FIG. 4 may perform the method of the embodiment shown in FIG. 1 to FIG. 3 .
  • FIG. 5 is a schematic structural diagram of a movable platform provided by an embodiment of the present invention. In FIG. 5 , it is illustrated by taking the movable platform implemented as an unmanned aerial vehicle as an example.
  • the movable platform includes: a body 21 , a power system 22 arranged on the body 21 , and a filter device 23 arranged on the body.
  • the filtering device 23 may be the device in the embodiment shown in FIG. 4 .
  • the power system 22 of the drone may include an electronic governor, one or more rotors, and one or more motors corresponding to the one or more rotors.
  • an embodiment of the present invention further provides a computer-readable storage medium, where executable codes are stored in the computer-readable storage medium, and the executable codes are used to implement the filtering methods provided by the foregoing embodiments.

Landscapes

  • Engineering & Computer Science (AREA)
  • Multimedia (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Power Engineering (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Measurement Of Mechanical Vibrations Or Ultrasonic Waves (AREA)

Abstract

Embodiments of the present invention provide a filtering method and apparatus, a movable platform, and a storage medium. The method comprises: acquiring a time-domain sensing signal affected by propeller vibration of an unmanned aerial vehicle, and a motor rotation frequency of the unmanned aerial vehicle; performing frequency-domain transformation on the time-domain sensing signal to obtain a correspondence between a sensing signal frequency and a sensing signal energy; on the basis of the correspondence between the sensing signal frequency and the sensing signal energy, determining the sensing signal energy corresponding to each of multiple frequency multiplications, the multiple frequency multiplications referring to sensing signal frequencies which are multiples of the motor rotation frequency; and according to a threshold of a filter corresponding to each of the multiple frequency multiplications, turning on a first filter corresponding to the frequency multiplication having the sensing signal energy greater than the corresponding threshold, and turning off a second filter corresponding to the frequency multiplication having the sensing signal energy less than the corresponding threshold. The filters designed by the present invention have relatively high rationality, and can better filter out interference signal energy generated by vibration excitation, thereby improving the control performance of a flight control system.

Description

滤波方法、装置、可移动平台和存储介质Filtering method, apparatus, removable platform and storage medium 技术领域technical field
本发明涉及信号处理技术领域,尤其涉及一种滤波方法、装置、可移动平台和存储介质。The present invention relates to the technical field of signal processing, and in particular, to a filtering method, device, movable platform and storage medium.
背景技术Background technique
当无人机在悬停或向前方飞行时,旋转的螺旋桨会带入一系列的振动激励,振动激励与无人机的飞行控制系统相互作用而造成无人机在飞行时的额外的干扰问题,从而这些振动激励最终会影响飞行控制系统的控制性能。When the UAV is hovering or flying forward, the rotating propeller will bring a series of vibration excitations. The vibration excitation interacts with the UAV's flight control system and causes additional interference problems when the UAV is flying. , so that these vibration excitations will eventually affect the control performance of the flight control system.
为了解决上述问题,相关技术中会使用滤波器滤除振动激励产生的干扰信号能量。滤波器设计的合理性会直接影响滤波效果,进而会对飞行控制系统的控制性能产生影响。In order to solve the above problem, in the related art, a filter is used to filter out the energy of the interference signal generated by the vibration excitation. The rationality of the filter design will directly affect the filtering effect, which in turn will affect the control performance of the flight control system.
相关技术中设计的滤波器的合理性较差,因此亟需设计一种合理性较高的滤波器,以滤除振动激励产生的干扰信号能量,从而提高飞行控制系统的控制性能。The rationality of the filter designed in the related art is poor, so it is urgent to design a filter with high rationality to filter out the energy of the interference signal generated by the vibration excitation, thereby improving the control performance of the flight control system.
发明内容SUMMARY OF THE INVENTION
本发明实施例提供一种滤波方法、装置、可移动平台和存储介质,用以设计一种合理性较高的滤波器,以滤除振动激励产生的干扰信号能量,从而提高飞行控制系统的控制性能。Embodiments of the present invention provide a filtering method, a device, a movable platform and a storage medium, which are used to design a filter with high rationality to filter out the energy of interference signals generated by vibration excitation, thereby improving the control of the flight control system. performance.
第一方面,本发明实施例提供一种滤波方法,该方法包括:In a first aspect, an embodiment of the present invention provides a filtering method, which includes:
获取受无人机的螺旋桨振动影响的时域感知信号,以及所述无人机的电机旋转频率;Obtain the time domain perception signal affected by the vibration of the propeller of the drone, and the rotation frequency of the motor of the drone;
对所述时域感知信号进行频域变换,以得到感知信号频率与感知信号能量的对应关系;Perform frequency domain transformation on the time domain sensing signal to obtain the corresponding relationship between the sensing signal frequency and the sensing signal energy;
基于所述感知信号频率与感知信号能量的对应关系,确定多种倍频各自对应的感知信号能量,所述多种倍频是指与所述电机旋转频率呈多种倍数关系的感知信号频率;Based on the corresponding relationship between the sensing signal frequency and the sensing signal energy, determine the sensing signal energy corresponding to each of the multiple frequency multiplications, where the multiple frequency multiples refer to the sensing signal frequencies that are in multiple multiples of the rotation frequency of the motor;
根据所述多种倍频各自对应的滤波器的阈值,开启感知信号能量大于对应阈值的倍频所对应的第一滤波器,且关闭感知信号能量小于对应阈值的倍频所对应的第二滤波器。According to the thresholds of the filters corresponding to the various frequency multipliers, the first filter corresponding to the frequency multiplier with the energy of the sensing signal greater than the corresponding threshold is turned on, and the second filter corresponding to the frequency multiplication with the energy of the sensory signal smaller than the corresponding threshold is turned off. device.
第二方面,本发明实施例提供一种滤波装置,包括存储器、处理器;其中,所述存储器上存储有可执行代码,当所述可执行代码被所述处理器执行时,使所述处理器实现:In a second aspect, an embodiment of the present invention provides a filtering device, including a memory and a processor; wherein, executable code is stored on the memory, and when the executable code is executed by the processor, the processing is performed. implements:
获取受无人机的螺旋桨振动影响的时域感知信号,以及所述无人机的电机旋转频率;Obtain the time domain perception signal affected by the vibration of the propeller of the drone, and the rotation frequency of the motor of the drone;
对所述时域感知信号进行频域变换,以得到感知信号频率与感知信号能量的对应关系;Perform frequency domain transformation on the time domain sensing signal to obtain the corresponding relationship between the sensing signal frequency and the sensing signal energy;
基于所述感知信号频率与感知信号能量的对应关系,确定多种倍频各自对应的感知信号能量,所述多种倍频是指与所述电机旋转频率呈多种倍数关系的感知信号频率;Based on the corresponding relationship between the sensing signal frequency and the sensing signal energy, determine the sensing signal energy corresponding to each of the multiple frequency multiplications, where the multiple frequency multiples refer to the sensing signal frequencies that are in multiple multiples of the rotation frequency of the motor;
根据所述多种倍频各自对应的滤波器的阈值,控制开启感知信号能量大于对应阈值的倍频所对应的第一滤波器,且控制关闭感知信号能量小于对应阈值的倍频所对应的第二滤波器。According to the thresholds of the filters corresponding to each of the multiple frequency multipliers, the first filter corresponding to the frequency multiplication with the energy of the sensing signal greater than the corresponding threshold is controlled to be turned on, and the first filter corresponding to the frequency multiplication with the energy of the sensing signal less than the corresponding threshold is controlled to be turned off. Second filter.
第三方面,本发明实施例提供一种可移动平台,包括:In a third aspect, an embodiment of the present invention provides a movable platform, including:
机体;body;
动力系统,设于所述机体,所述动力系统用于为所述可移动平台提供动力;a power system, arranged on the body, the power system is used to provide power for the movable platform;
以及本发明实施例第二方面提供的滤波装置,所述滤波装置设置于所述机体上。And the filtering device provided by the second aspect of the embodiment of the present invention, the filtering device is disposed on the body.
第四方面,本发明实施例提供了一种计算机可读存储介质,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于实现本发明实施例第一方面提供的滤波方法。In a fourth aspect, an embodiment of the present invention provides a computer-readable storage medium, where the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement the present invention The filtering method provided by the first aspect of the embodiment.
采用本发明,可以显著降低旋转的螺旋桨带入的一系列的振动激励对时域感知信号的影响。如果某个倍频对应的感知信号能量小于对应的滤波器的阈值,则可以关闭感知信号能量小于对应阈值的倍频所对应的滤波器,这样可以最大限度的关闭不需要使用的滤波器,进而可以保证控制器的相位裕度。同时,如果某个倍频对应的感知信号能量大于对应的滤波器的阈值,则可以开启感知信号能量大于对应阈值的倍频所对应的滤波器,这样可以使用相应的滤波器滤除超出容忍限度的某个倍频对应的感知信号能量,继而可以保证能量不达标的倍频对应的感知信号能量都被滤除,以保证控制器能够发挥出极限控制性能。可见,本发明设计的滤波器的合理性较高,能够较好的滤除振动激励产生的干扰信号能量,从而提高飞行控制系统的控制性能。By adopting the present invention, the influence of a series of vibration excitations brought by the rotating propeller on the time-domain perception signal can be significantly reduced. If the energy of the perceptual signal corresponding to a certain octave is less than the threshold of the corresponding filter, the filter corresponding to the octave of which the energy of the perceptual signal is less than the corresponding threshold can be turned off, so that the filters that do not need to be used can be closed to the maximum extent, and then The phase margin of the controller can be guaranteed. At the same time, if the energy of the perceptual signal corresponding to a certain octave is greater than the threshold of the corresponding filter, the filter corresponding to the octave whose energy of the perceptual signal is greater than the corresponding threshold can be turned on, so that the corresponding filter can be used to filter out the excess of the tolerance limit. The energy of the sensing signal corresponding to a certain frequency multiplier, and then it can ensure that the energy of the sensory signal corresponding to the frequency multiplication that does not reach the standard is filtered out, so as to ensure that the controller can exert the limit control performance. It can be seen that the filter designed by the present invention has high rationality and can better filter out the interference signal energy generated by vibration excitation, thereby improving the control performance of the flight control system.
附图说明Description of drawings
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to illustrate the technical solutions in the embodiments of the present invention more clearly, the following briefly introduces the accompanying drawings used in the description of the embodiments. Obviously, the drawings in the following description are some embodiments of the present invention. For those of ordinary skill in the art, other drawings can also be obtained from these drawings without creative effort.
图1为本发明实施例提供的一种滤波方法的流程图示意图;1 is a schematic flowchart of a filtering method according to an embodiment of the present invention;
图2为本发明实施例提供的一种具有目标深度的第一滤波器对大于对应阈值的感知信号能量进行滤除处理的示意图;2 is a schematic diagram of a first filter with a target depth that performs filtering processing on perceptual signal energy greater than a corresponding threshold according to an embodiment of the present invention;
图3为本发明实施例提供的一种滤波方法的另一流程示意图;3 is another schematic flowchart of a filtering method provided by an embodiment of the present invention;
图4为本发明实施例提供的一种滤波装置的结构示意图;FIG. 4 is a schematic structural diagram of a filtering device according to an embodiment of the present invention;
图5为本发明实施例提供的一种可移动平台的结构示意图。FIG. 5 is a schematic structural diagram of a movable platform according to an embodiment of the present invention.
具体实施方式Detailed ways
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中 的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the purposes, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments These are some embodiments of the present invention, but not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative work, all belong to the protection scope of the present invention.
在本发明实施例中使用的术语是仅仅出于描述特定实施例的目的,而非旨在限制本发明。在本发明实施例和所附权利要求书中所使用的单数形式的“一种”、“所述”和“该”也旨在包括多数形式,除非上下文清楚地表示其他含义,“多种”一般包含至少两种。The terms used in the embodiments of the present invention are only for the purpose of describing specific embodiments, and are not intended to limit the present invention. The singular forms "a," "the," and "the" as used in the embodiments of the present invention and the appended claims are intended to include the plural forms as well, unless the context clearly dictates otherwise, "a plurality" Generally at least two are included.
取决于语境,如在此所使用的词语“如果”、“若”可以被解释成为“在……时”或“当……时”或“响应于确定”或“响应于检测”。类似地,取决于语境,短语“如果确定”或“如果检测(陈述的条件或事件)”可以被解释成为“当确定时”或“响应于确定”或“当检测(陈述的条件或事件)时”或“响应于检测(陈述的条件或事件)”。Depending on the context, the words "if", "if" as used herein may be interpreted as "at" or "when" or "in response to determining" or "in response to detecting". Similarly, the phrases "if determined" or "if detected (the stated condition or event)" can be interpreted as "when determined" or "in response to determining" or "when detected (the stated condition or event)," depending on the context )" or "in response to detection (a stated condition or event)".
另外,下述各方法实施例中的步骤时序仅为一种举例,而非严格限定。In addition, the sequence of steps in the following method embodiments is only an example, and is not strictly limited.
图1为本发明实施例提供的一种滤波方法的流程图,如图1所示,该方法包括如下步骤:FIG. 1 is a flowchart of a filtering method provided by an embodiment of the present invention. As shown in FIG. 1 , the method includes the following steps:
101、获取受无人机的螺旋桨振动影响的时域感知信号,以及无人机的电机旋转频率。101. Acquire a time-domain perception signal affected by the vibration of the propeller of the drone, and the rotation frequency of the motor of the drone.
102、对时域感知信号进行频域变换,以得到感知信号频率与感知信号能量的对应关系。102. Perform frequency domain transformation on the time domain sensing signal to obtain a corresponding relationship between the sensing signal frequency and the sensing signal energy.
103、基于感知信号频率与感知信号能量的对应关系,确定多种倍频各自对应的感知信号能量,多种倍频是指与电机旋转频率呈多种倍数关系的感知信号频率。103. Based on the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal, determine the energy of the sensing signal corresponding to each of the multiple frequencies, where the multiple frequencies refer to the frequencies of the sensing signals that have multiple relationships with the rotation frequency of the motor.
104、根据多种倍频各自对应的滤波器的阈值,开启感知信号能量大于对应阈值的倍频所对应的第一滤波器,且关闭感知信号能量小于对应阈值的倍频所对应的第二滤波器。104. According to the thresholds of the filters corresponding to the various frequency multipliers, turn on the first filter corresponding to the frequency multiplier whose perceptual signal energy is greater than the corresponding threshold, and close the second filter corresponding to the multiplier whose perceptual signal energy is less than the corresponding threshold. device.
实际应用中,当无人机在悬停或向前方飞行时,旋转的螺旋桨会带入一系列的振动激励,振动激励与无人机的飞行控制系统相互作用而造成无人机在飞行时的额外的干扰问题。具体来说,振动激励会作用到飞行控制系统中的一些 受无人机的螺旋桨振动影响的时域感知信号上,进而会影响时域感知信号的准确性,导致飞行控制系统基于准确性较低的时域感知信号而进行存在较大误差的控制。In practical applications, when the drone is hovering or flying forward, the rotating propeller will bring a series of vibration excitations, and the vibration excitation interacts with the drone's flight control system to cause the drone to fly. Additional interference issues. Specifically, vibration excitation will act on some time-domain perception signals in the flight control system that are affected by the vibration of the UAV's propeller, which in turn will affect the accuracy of the time-domain perception signals, resulting in the flight control system based on low accuracy. The time-domain perception signal is used for control with large error.
可选地,上述受无人机的螺旋桨振动影响的时域感知信号例如可以是惯性测量单元(Inertial Measurement Unit,IMU)检测信号等。IMU信号可以反映无人机机身的运动状态,它是一种时域信号。Optionally, the above-mentioned time-domain perception signal affected by the vibration of the propeller of the drone may be, for example, an inertial measurement unit (Inertial Measurement Unit, IMU) detection signal or the like. The IMU signal can reflect the motion state of the drone body, and it is a time domain signal.
可选地,获取受无人机的螺旋桨振动影响的时域感知信号的过程可以实现为:获取受无人机的螺旋桨振动影响的时域感知信号的采集频率;获取预设采集时长;在预设采集时长内按照采集频率,采集时域感知信号。Optionally, the process of acquiring the time-domain perception signal affected by the vibration of the propeller of the drone may be implemented as follows: acquiring the acquisition frequency of the time-domain perception signal affected by the vibration of the propeller of the drone; acquiring a preset acquisition duration; Set the time domain perception signal to be collected according to the collection frequency within the collection duration.
实际应用中,可以按照采集频率在预设采集时长内采集时域感知信号,这样时域感知信号包括时域上固定数目的数值。例如,以2000Hz的采集频率在0.1s内采集时域感知信号,可以采集到200个数值。In practical applications, the time domain sensing signal may be collected within a preset collection duration according to the collection frequency, so that the time domain sensing signal includes a fixed number of values in the time domain. For example, if the time-domain perception signal is collected within 0.1s at a collection frequency of 2000Hz, 200 values can be collected.
可以理解的是,上述采集时长可以根据实际需求进行设置。例如,可以根据飞行控制系统的计算资源进行设置,当飞行控制系统的计算资源较多时,可以适当增加采集时长,当飞行控制系统的计算资源较少时,可以适当减小采集时长。It can be understood that, the above collection duration can be set according to actual requirements. For example, it can be set according to the computing resources of the flight control system. When the computing resources of the flight control system are large, the acquisition duration can be appropriately increased, and when the computing resources of the flight control system are small, the acquisition duration can be appropriately reduced.
在获取到时域感知信号之后,可以对时域感知信号进行频域变换。通过对时域感知信号的频域变换处理,可以得到感知信号频率与感知信号能量的对应关系。After the time domain sensing signal is acquired, frequency domain transformation can be performed on the time domain sensing signal. Through the frequency domain transformation processing of the time domain sensing signal, the corresponding relationship between the sensing signal frequency and the sensing signal energy can be obtained.
可选地,上述对时域感知信号进行频域变换,以得到感知信号频率与感知信号能量的对应关系的过程可以实现为:对时域感知信号进行离散傅里叶变换,以得到感知信号频率与感知信号能量的对应关系。Optionally, the above-mentioned process of performing frequency domain transformation on the time domain sensing signal to obtain the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal may be implemented as follows: performing discrete Fourier transform on the sensing signal in the time domain to obtain the frequency of the sensing signal. Corresponding relationship with perceptual signal energy.
在另一方面,还可以获取无人机的电机旋转频率,倍频为与电机旋转频率呈倍数关系的频率。例如,电机旋转频率为200Hz,一倍频为电机旋转频率的一倍即200Hz、二倍频为电机旋转频率的两倍即400Hz、三倍频为电机旋转频率的三倍即600Hz、四倍频为电机旋转频率的四倍即800Hz、六倍频为电机旋转频率的六倍即1200Hz,依次类推,可以计算出与电机旋转频率呈多种倍数关系的频 率。On the other hand, the rotation frequency of the motor of the drone can also be obtained, and the multiplier is a frequency that has a multiple relationship with the rotation frequency of the motor. For example, the rotation frequency of the motor is 200Hz, the double frequency is twice the rotation frequency of the motor, which is 200Hz, the double frequency is twice the rotation frequency of the motor, which is 400Hz, the triple frequency is three times the rotation frequency of the motor, which is 600Hz, and the quadruple frequency is 400Hz. It is four times the motor rotation frequency, namely 800Hz, and the sixfold frequency is six times the motor rotation frequency, that is, 1200Hz. By analogy, the frequency that is in various multiples of the motor rotation frequency can be calculated.
前面提到可以确定出感知信号频率与感知信号能量的对应关系,该对应关系中存在多个感知信号频率,多个感知信号频率中存在与电机旋转频率呈多种倍数关系的频率。可以基于上述对应关系,确定多种倍频各自对应的感知信号能量。As mentioned above, the corresponding relationship between the sensing signal frequency and the sensing signal energy can be determined. There are multiple sensing signal frequencies in the corresponding relationship, and among the multiple sensing signal frequencies, there are frequencies that are multiples of the motor rotation frequency. The perceptual signal energy corresponding to each of the multiple frequency multiplications can be determined based on the above-mentioned corresponding relationship.
实际应用中,可以获取多种倍频各自对应的滤波器的阈值。如果某个倍频未超过对应的滤波器的阈值,则可以认为该倍频对应噪音在容忍限度之内,可以不做滤波处理。如果某个倍频超过了对应的滤波器的阈值,则可以认为该倍频对应噪音已超出容忍限度,需要做滤波处理。在本发明实施例中,针对不同倍频设置有专门的滤波器进行滤波处理。基于此,可以根据多种倍频各自对应的滤波器的阈值,开启感知信号能量大于对应阈值的倍频所对应的第一滤波器,且关闭感知信号能量小于对应阈值的倍频所对应的第二滤波器。In practical applications, the thresholds of the filters corresponding to various frequency doublings can be obtained. If a certain frequency multiplier does not exceed the threshold of the corresponding filter, it can be considered that the noise corresponding to the frequency multiplier is within the tolerance limit, and no filtering processing is required. If an octave exceeds the threshold of the corresponding filter, it can be considered that the noise corresponding to the octave has exceeded the tolerance limit and needs to be filtered. In the embodiment of the present invention, special filters are provided for different frequency multiplications to perform filtering processing. Based on this, according to the thresholds of the filters corresponding to the various frequency multipliers, the first filter corresponding to the frequency multiplier whose perceptual signal energy is greater than the corresponding threshold value can be turned on, and the first filter corresponding to the frequency multiplication frequency whose perceptual signal energy is less than the corresponding threshold value can be turned off. Second filter.
需要说明的是,在上述获取多种倍频各自对应的滤波器的阈值之前,可以预先设置多种倍频对应的滤波器的阈值。具体来说,可以将多种倍频对应的滤波器的阈值设置为同一数值,也可以针对不同倍频设置不同的滤波器的阈值,对此本发明实施例不做限定。It should be noted that, before the above-mentioned acquisition of the thresholds of the filters corresponding to the various frequency multiplications, the thresholds of the filters corresponding to the various frequency multiplications may be preset. Specifically, the thresholds of filters corresponding to multiple frequency doublings may be set to the same value, or different filter thresholds may be set for different frequency doublings, which are not limited in this embodiment of the present invention.
可选地,在开启感知信号能量大于对应阈值的倍频所对应的第一滤波器之后,本发明实施例提供的方法还可以包括:通过第一滤波器,对大于对应阈值的感知信号能量进行滤除处理。Optionally, after turning on the first filter corresponding to the frequency multiplier of which the energy of the sensing signal is greater than the corresponding threshold, the method provided by the embodiment of the present invention may further include: performing a filter on the energy of the sensing signal greater than the corresponding threshold through the first filter. Filter out processing.
本发明实施例不对滤波器的种类进行限定,只要可以滤除感知信号能量的滤波器都可以纳入考虑范围之内。在一种可能的实现方式中,可以使用陷波滤波器滤除感知信号能量。The embodiment of the present invention does not limit the type of the filter, as long as the filter that can filter the energy of the sensing signal can be taken into consideration. In one possible implementation, a notch filter may be used to filter out the perceptual signal energy.
相应地,上述通过第一滤波器,对大于对应阈值的感知信号能量进行滤除处理的过程可以实现为:基于大于对应阈值的感知信号能量,确定第一滤波器的目标深度;使用具有目标深度的第一滤波器对大于对应阈值的感知信号能量进行滤除处理。Correspondingly, the above-mentioned process of filtering out the perceptual signal energy greater than the corresponding threshold through the first filter can be implemented as follows: based on the perceptual signal energy greater than the corresponding threshold, the target depth of the first filter is determined; The first filter performs filtering processing on the perceptual signal energy greater than the corresponding threshold.
需要说明的是,陷波滤波器具有两种滤波参数,包括宽度和深度。在本发 明实施例中,可以认为陷波滤波器的宽度为固定数值,可以根据大于对应阈值的感知信号能量调整第一滤波器的深度。这样可以通过与大于对应阈值的感知信号能量适应的第一滤波器对感知信号能量进行滤波,所得的滤波效果更好。It should be noted that the notch filter has two filtering parameters, including width and depth. In this embodiment of the present invention, it can be considered that the width of the notch filter is a fixed value, and the depth of the first filter can be adjusted according to the energy of the sensing signal greater than the corresponding threshold. In this way, the perceptual signal energy can be filtered by the first filter adapted to the perceptual signal energy greater than the corresponding threshold, and the obtained filtering effect is better.
本发明实施例提供一种计算第一滤波器的目标深度的方式。可选地,上述基于大于对应阈值的感知信号能量,确定第一滤波器的目标深度的过程可以实现为:确定大于对应阈值的感知信号能量的倒数,作为第一滤波器的目标深度。The embodiment of the present invention provides a method for calculating the target depth of the first filter. Optionally, the above process of determining the target depth of the first filter based on the perceptual signal energy greater than the corresponding threshold may be implemented as: determining the reciprocal of the perceptual signal energy greater than the corresponding threshold as the target depth of the first filter.
举例来说,假设大于对应阈值的感知信号能量为5,那么第一滤波器的目标深度可以设置为1/5。假设大于对应阈值的感知信号能量为6,那么第一滤波器的目标深度可以设置为1/6。For example, assuming that the perceptual signal energy greater than the corresponding threshold is 5, the target depth of the first filter can be set to 1/5. Assuming that the perceptual signal energy greater than the corresponding threshold is 6, the target depth of the first filter can be set to 1/6.
为了更加直观地理解具有目标深度的第一滤波器对大于对应阈值的感知信号能量进行滤除处理的过程,结合图2来示例性说明,如图2上图所示,首先可以采集到具有固定数目的数值的IMU信号。然后对IMU信号进行离散傅里叶变换,如图2中图所示,得到IMU信号频率与IMU信号能量的对应关系。In order to more intuitively understand the process of filtering out the perceptual signal energy greater than the corresponding threshold by the first filter with the target depth, an exemplary illustration is given with reference to FIG. 2. As shown in the upper figure of FIG. Number of numeric IMU signals. Then, the discrete Fourier transform is performed on the IMU signal, as shown in the figure in Figure 2, to obtain the corresponding relationship between the frequency of the IMU signal and the energy of the IMU signal.
在图2中图中,100Hz为一倍频且200Hz为二倍频,假设一倍频对应的IMU信号能量为6,二倍频对应的IMU信号能量也为6,它们对应的滤波器的阈值都是4,那么需要对一倍频和二倍频处的IMU信号能量进行滤波处理。用于滤除一倍频对应的IMU信号能量的第一陷波滤波器的深度可以设置为1/6,用于滤除二倍频对应的IMU信号能量的第二陷波滤波器的深度也可以设置为1/6。In the figure in Figure 2, 100Hz is a double frequency and 200Hz is a double frequency. It is assumed that the IMU signal energy corresponding to the double frequency is 6, and the IMU signal energy corresponding to the double frequency is also 6, and their corresponding filter thresholds Both are 4, then it is necessary to filter the IMU signal energy at frequency 1 and frequency 2. The depth of the first notch filter used to filter out the energy of the IMU signal corresponding to the double frequency can be set to 1/6, and the depth of the second notch filter used to filter out the energy of the IMU signal corresponding to the double frequency is also Can be set to 1/6.
第一陷波滤波器和第二陷波滤波器的滤波频率与深度的对应关系可见图2下图所示。由图2中图和下图可以看出,两个波形相对于横坐标轴是相反的。在滤波过程中,相当于两个波形进行叠加,那么叠加结果接近或者等于0,也就是说,通过第一陷波滤波器和第二陷波滤波器可以滤除一倍频对应的IMU信号能量和二倍频对应的IMU信号能量。The corresponding relationship between the filtering frequency and the depth of the first notch filter and the second notch filter can be seen in the lower part of FIG. 2 . As can be seen from the middle and lower graphs in Figure 2, the two waveforms are opposite to the abscissa axis. In the filtering process, it is equivalent to superimposing two waveforms, then the superposition result is close to or equal to 0, that is to say, the IMU signal energy corresponding to one frequency can be filtered out by the first notch filter and the second notch filter. The IMU signal energy corresponding to the double frequency.
综上,本发明实施例提供的滤波方法的另一流程图可见图3所示。首先可以对时域上连续的时域感知信号进行滑窗处理,滑窗处理具体可以是按照采集频率在预设采集时长内采集一段时域感知信号。然后可以对该段时域感知信号进行离散傅里叶变换。需要说明的是,由于旋转的螺旋桨会带入一系列的振动 激励,振动激励会对上述一段时域感知信号产生影响,因此离散傅里叶变换的对象实际是该段时域感知信号和振动激励的互相作用的结果。To sum up, another flowchart of the filtering method provided by the embodiment of the present invention is shown in FIG. 3 . First, sliding window processing may be performed on the continuous time domain sensing signals in the time domain. Specifically, the sliding window processing may be to collect a period of time domain sensing signals within a preset collection period according to the collection frequency. Then the discrete Fourier transform can be performed on the time-domain perception signal. It should be noted that since the rotating propeller will bring a series of vibration excitations, the vibration excitation will have an impact on the above-mentioned time-domain perception signal, so the object of the discrete Fourier transform is actually the time-domain perception signal and vibration excitation. the result of the interaction.
在经过离散傅里叶变换之后,可以得到感知信号频率与感知信号能量的对应关系,然后可以基于该对应关系确定多种倍频各自对应的感知信号能量。如果某个倍频对应的感知信号能量大于对应的滤波器的阈值,则开启感知信号能量大于对应阈值的倍频所对应的第一滤波器。如果某个倍频对应的感知信号能量小于对应的滤波器的阈值,则关闭感知信号能量小于对应阈值的倍频所对应的第二滤波器。After the discrete Fourier transform, the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal can be obtained, and then the corresponding energy of the sensing signal can be determined based on the corresponding relationship. If the energy of the perceptual signal corresponding to a certain frequency is greater than the threshold of the corresponding filter, the first filter corresponding to the frequency of the frequency of which the energy of the perceptual signal is greater than the corresponding threshold is turned on. If the energy of the perceptual signal corresponding to a certain frequency is less than the threshold of the corresponding filter, the second filter corresponding to the frequency of which the energy of the perceptual signal is less than the corresponding threshold is turned off.
采用本发明,可以显著降低旋转的螺旋桨带入的一系列的振动激励对时域感知信号的影响。如果某个倍频对应的感知信号能量小于对应的滤波器的阈值,则可以关闭感知信号能量小于对应阈值的倍频所对应的滤波器,这样可以最大限度的关闭不需要使用的滤波器,进而可以保证控制器的相位裕度。同时,如果某个倍频对应的感知信号能量大于对应的滤波器的阈值,则可以开启感知信号能量大于对应阈值的倍频所对应的滤波器,这样可以使用相应的滤波器滤除超出容忍限度的某个倍频对应的感知信号能量,继而可以保证能量不达标的倍频对应的感知信号能量都被滤除,以保证控制器能够发挥出极限控制性能。可见,本发明设计的滤波器的合理性较高,能够较好的滤除振动激励产生的干扰信号能量,从而提高飞行控制系统的控制性能。By adopting the present invention, the influence of a series of vibration excitations brought by the rotating propeller on the time-domain perception signal can be significantly reduced. If the energy of the perceptual signal corresponding to a certain octave is less than the threshold of the corresponding filter, the filter corresponding to the octave of which the energy of the perceptual signal is less than the corresponding threshold can be turned off, so that the filters that do not need to be used can be closed to the maximum extent, and then The phase margin of the controller can be guaranteed. At the same time, if the energy of the perceptual signal corresponding to a certain octave is greater than the threshold of the corresponding filter, the filter corresponding to the octave whose energy of the perceptual signal is greater than the corresponding threshold can be turned on, so that the corresponding filter can be used to filter out the excess of the tolerance limit. The energy of the sensing signal corresponding to a certain frequency multiplier, and then it can ensure that the energy of the sensory signal corresponding to the frequency multiplication that does not reach the standard is filtered out, so as to ensure that the controller can exert the limit control performance. It can be seen that the filter designed by the present invention has high rationality and can better filter out the interference signal energy generated by vibration excitation, thereby improving the control performance of the flight control system.
本发明又一示例性实施例提供了一种滤波装置,如图4所示,该装置包括:Yet another exemplary embodiment of the present invention provides a filtering device, as shown in FIG. 4 , the device includes:
存储器1910,用于存储计算机程序;memory 1910 for storing computer programs;
处理器1920,用于运行存储器1910中存储的计算机程序以实现:The processor 1920 is used for running the computer program stored in the memory 1910 to realize:
获取受无人机的螺旋桨振动影响的时域感知信号,以及所述无人机的电机旋转频率;Obtain the time domain perception signal affected by the vibration of the propeller of the drone, and the rotation frequency of the motor of the drone;
对所述时域感知信号进行频域变换,以得到感知信号频率与感知信号能量的对应关系;Perform frequency domain transformation on the time domain sensing signal to obtain the corresponding relationship between the sensing signal frequency and the sensing signal energy;
基于所述感知信号频率与感知信号能量的对应关系,确定多种倍频各自对应的感知信号能量,所述多种倍频是指与所述电机旋转频率呈多种倍数关系的 感知信号频率;Based on the corresponding relationship between the perceptual signal frequency and the perceptual signal energy, determine the perceptual signal energy corresponding to each of multiple frequency multiplications, and the multiple frequency multiplication refers to the perceptual signal frequency that is in a multiple multiple relationship with the rotation frequency of the motor;
根据所述多种倍频各自对应的滤波器的阈值,控制开启感知信号能量大于对应阈值的倍频所对应的第一滤波器,且控制关闭感知信号能量小于对应阈值的倍频所对应的第二滤波器。According to the thresholds of the filters corresponding to each of the multiple frequency multipliers, the first filter corresponding to the frequency multiplication with the energy of the sensing signal greater than the corresponding threshold is controlled to be turned on, and the first filter corresponding to the frequency multiplication with the energy of the sensing signal less than the corresponding threshold is controlled to be turned off. Second filter.
可选地,所述处理器1920,还用于:Optionally, the processor 1920 is further configured to:
控制所述第一滤波器,对大于对应阈值的感知信号能量进行滤除处理。The first filter is controlled to filter out the energy of the sensing signal greater than the corresponding threshold.
可选地,所述滤波器为陷波滤波器。Optionally, the filter is a notch filter.
可选地,所述处理器1920,用于:Optionally, the processor 1920 is configured to:
基于大于对应阈值的感知信号能量,确定所述第一滤波器的目标深度;determining the target depth of the first filter based on the perceptual signal energy greater than the corresponding threshold;
控制具有所述目标深度的第一滤波器对所述大于对应阈值的感知信号能量进行滤除处理。The first filter with the target depth is controlled to perform filtering processing on the perceptual signal energy greater than the corresponding threshold.
可选地,所述处理器1920,用于:Optionally, the processor 1920 is configured to:
确定大于对应阈值的感知信号能量的倒数,作为所述第一滤波器的目标深度。The inverse of the perceptual signal energy greater than the corresponding threshold is determined as the target depth of the first filter.
可选地,所述受无人机的螺旋桨振动影响的时域感知信号包括惯性测量单元检测信号。Optionally, the time-domain perception signal affected by the vibration of the propeller of the drone includes an inertial measurement unit detection signal.
可选地,所述处理器1920,用于:Optionally, the processor 1920 is configured to:
对所述时域感知信号进行离散傅里叶变换,以得到感知信号频率与感知信号能量的对应关系。Discrete Fourier transform is performed on the time-domain sensing signal to obtain the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal.
可选地,所述处理器1920,用于:Optionally, the processor 1920 is configured to:
获取受无人机的螺旋桨振动影响的时域感知信号的采集频率;Obtain the acquisition frequency of the time-domain perception signal affected by the propeller vibration of the drone;
获取预设采集时长;Get the preset collection time;
在所述预设采集时长内按照所述采集频率,采集所述时域感知信号。The time domain sensing signal is collected according to the collection frequency within the preset collection time period.
图4所示的滤波装置可以执行图1-图3所示实施例的方法,本实施例未详细描述的部分,可参考对图1-图3所示实施例的相关说明。该技术方案的执行过程和技术效果参见图1-图3所示实施例中的描述,在此不再赘述。The filtering apparatus shown in FIG. 4 may perform the method of the embodiment shown in FIG. 1 to FIG. 3 . For parts not described in detail in this embodiment, reference may be made to the related description of the embodiment shown in FIG. 1 to FIG. 3 . For the execution process and technical effects of the technical solution, refer to the descriptions in the embodiments shown in FIG. 1 to FIG. 3 , which will not be repeated here.
图5为本发明实施例提供的一种可移动平台的结构示意图,在图5中,以 该可移动平台实现为无人机为例进行的示意。FIG. 5 is a schematic structural diagram of a movable platform provided by an embodiment of the present invention. In FIG. 5 , it is illustrated by taking the movable platform implemented as an unmanned aerial vehicle as an example.
如图5所示,该可移动平台包括:机体21、设于机体21上的动力系统22以及设置于机体的滤波装置23。该滤波装置23可以是图4所示实施例的装置。本实施例未详细描述的部分,可参考对图4所示实施例的相关说明。As shown in FIG. 5 , the movable platform includes: a body 21 , a power system 22 arranged on the body 21 , and a filter device 23 arranged on the body. The filtering device 23 may be the device in the embodiment shown in FIG. 4 . For parts that are not described in detail in this embodiment, reference may be made to the relevant description of the embodiment shown in FIG. 4 .
无人机的动力系统22可以包括电子调速器、一个或多个旋翼以及与该一个或多个旋翼对应的一个或多个电机。The power system 22 of the drone may include an electronic governor, one or more rotors, and one or more motors corresponding to the one or more rotors.
无人机上还可以设置诸如惯性测量单元等其他器件(图中未示出),在此不列举。Other devices such as inertial measurement units (not shown in the figure) may also be provided on the UAV, which are not listed here.
另外,本发明实施例还提供一种计算机可读存储介质,所述计算机可读存储介质中存储有可执行代码,所述可执行代码用于实现如前述各实施例提供的滤波方法。In addition, an embodiment of the present invention further provides a computer-readable storage medium, where executable codes are stored in the computer-readable storage medium, and the executable codes are used to implement the filtering methods provided by the foregoing embodiments.
以上各个实施例中的技术方案、技术特征在不相冲突的情况下均可以单独,或者进行组合,只要未超出本领域技术人员的认知范围,均属于本发明保护范围内的等同实施例。The technical solutions and technical features in each of the above embodiments can be used alone or in combination without conflict. As long as they do not exceed the cognitive scope of those skilled in the art, they all belong to equivalent embodiments within the protection scope of the present invention.
以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。The above descriptions are only the embodiments of the present invention, and are not intended to limit the scope of the present invention. Any equivalent structure or equivalent process transformation made by using the contents of the description and drawings of the present invention, or directly or indirectly applied to other related technologies Fields are similarly included in the scope of patent protection of the present invention.
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, but not to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: The technical solutions described in the foregoing embodiments can still be modified, or some or all of the technical features thereof can be equivalently replaced; and these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the technical solutions of the embodiments of the present invention. scope.

Claims (18)

  1. 一种滤波方法,其特征在于,包括:A filtering method, comprising:
    获取受无人机的螺旋桨振动影响的时域感知信号,以及所述无人机的电机旋转频率;Obtain the time domain perception signal affected by the vibration of the propeller of the drone, and the rotation frequency of the motor of the drone;
    对所述时域感知信号进行频域变换,以得到感知信号频率与感知信号能量的对应关系;Perform frequency domain transformation on the time domain sensing signal to obtain the corresponding relationship between the sensing signal frequency and the sensing signal energy;
    基于所述感知信号频率与感知信号能量的对应关系,确定多种倍频各自对应的感知信号能量,所述多种倍频是指与所述电机旋转频率呈多种倍数关系的感知信号频率;Based on the corresponding relationship between the sensing signal frequency and the sensing signal energy, determine the sensing signal energy corresponding to each of the multiple frequency multiplications, where the multiple frequency multiples refer to the sensing signal frequencies that are in multiple multiples of the rotation frequency of the motor;
    根据所述多种倍频各自对应的滤波器的阈值,开启感知信号能量大于对应阈值的倍频所对应的第一滤波器,且关闭感知信号能量小于对应阈值的倍频所对应的第二滤波器。According to the thresholds of the filters corresponding to each of the multiple frequency multipliers, the first filter corresponding to the frequency multiplication with the energy of the sensing signal greater than the corresponding threshold is turned on, and the second filter corresponding to the frequency multiplication with the energy of the sensory signal smaller than the corresponding threshold is turned off. device.
  2. 根据权利要求1所述的方法,其特征在于,在开启感知信号能量大于对应阈值的倍频所对应的第一滤波器之后,所述方法还包括:The method according to claim 1, wherein after turning on the first filter corresponding to a frequency multiplier whose energy of the sensing signal is greater than the corresponding threshold, the method further comprises:
    通过所述第一滤波器,对大于对应阈值的感知信号能量进行滤除处理。Through the first filter, the energy of the sensing signal greater than the corresponding threshold is filtered out.
  3. 根据权利要求2所述的方法,其特征在于,所述滤波器为陷波滤波器。The method according to claim 2, wherein the filter is a notch filter.
  4. 根据权利要求3所述的方法,其特征在于,所述通过所述第一滤波器,对大于对应阈值的感知信号能量进行滤除处理,包括:The method according to claim 3, characterized in that, performing filtering processing on the perceptual signal energy greater than a corresponding threshold through the first filter, comprising:
    基于大于对应阈值的感知信号能量,确定所述第一滤波器的目标深度;determining the target depth of the first filter based on the perceptual signal energy greater than the corresponding threshold;
    使用具有所述目标深度的第一滤波器对所述大于对应阈值的感知信号能量进行滤除处理。The perceptual signal energy greater than the corresponding threshold is filtered using the first filter having the target depth.
  5. 根据权利要求4所述的方法,其特征在于,所述基于大于对应阈值的感知信号能量,确定所述第一滤波器的目标深度,包括:The method according to claim 4, wherein the determining the target depth of the first filter based on the perceptual signal energy greater than a corresponding threshold value comprises:
    确定大于对应阈值的感知信号能量的倒数,作为所述第一滤波器的目标深度。The inverse of the perceptual signal energy greater than the corresponding threshold is determined as the target depth of the first filter.
  6. 根据权利要求1-5中任一项所述的方法,其特征在于,所述受无人机的 螺旋桨振动影响的时域感知信号包括惯性测量单元检测信号。The method according to any one of claims 1-5, wherein the time domain perception signal affected by the vibration of the propeller of the drone comprises an inertial measurement unit detection signal.
  7. 根据权利要求1所述的方法,其特征在于,所述对所述时域感知信号进行频域变换,以得到感知信号频率与感知信号能量的对应关系,包括:The method according to claim 1, wherein the performing frequency domain transformation on the time domain sensing signal to obtain the corresponding relationship between the sensing signal frequency and the sensing signal energy, comprising:
    对所述时域感知信号进行离散傅里叶变换,以得到感知信号频率与感知信号能量的对应关系。Discrete Fourier transform is performed on the time-domain sensing signal to obtain the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal.
  8. 根据权利要求1所述的方法,其特征在于,所述获取受无人机的螺旋桨振动影响的时域感知信号,包括:The method according to claim 1, wherein the acquiring the time domain perception signal affected by the vibration of the propeller of the drone comprises:
    获取受无人机的螺旋桨振动影响的时域感知信号的采集频率;Obtain the acquisition frequency of the time-domain perception signal affected by the propeller vibration of the drone;
    获取预设采集时长;Get the preset collection time;
    在所述预设采集时长内按照所述采集频率,采集所述时域感知信号。The time domain sensing signal is collected according to the collection frequency within the preset collection time period.
  9. 一种滤波装置,其特征在于,包括存储器、处理器;其中,所述存储器上存储有可执行代码,当所述可执行代码被所述处理器执行时,使所述处理器实现:A filtering device, comprising a memory and a processor; wherein, executable code is stored on the memory, and when the executable code is executed by the processor, the processor is made to realize:
    获取受无人机的螺旋桨振动影响的时域感知信号,以及所述无人机的电机旋转频率;Obtain the time domain perception signal affected by the vibration of the propeller of the drone, and the rotation frequency of the motor of the drone;
    对所述时域感知信号进行频域变换,以得到感知信号频率与感知信号能量的对应关系;Perform frequency domain transformation on the time domain sensing signal to obtain the corresponding relationship between the sensing signal frequency and the sensing signal energy;
    基于所述感知信号频率与感知信号能量的对应关系,确定多种倍频各自对应的感知信号能量,所述多种倍频是指与所述电机旋转频率呈多种倍数关系的感知信号频率;Based on the corresponding relationship between the sensing signal frequency and the sensing signal energy, determine the sensing signal energy corresponding to each of the multiple frequency multiplications, where the multiple frequency multiples refer to the sensing signal frequencies that are in multiple multiples of the rotation frequency of the motor;
    根据所述多种倍频各自对应的滤波器的阈值,控制开启感知信号能量大于对应阈值的倍频所对应的第一滤波器,且控制关闭感知信号能量小于对应阈值的倍频所对应的第二滤波器。According to the thresholds of the filters corresponding to each of the multiple frequency multipliers, the first filter corresponding to the frequency multiplication with the energy of the sensing signal greater than the corresponding threshold is controlled to be turned on, and the first filter corresponding to the frequency multiplication with the energy of the sensing signal less than the corresponding threshold is controlled to be turned off. Second filter.
  10. 根据权利要求9所述的装置,其特征在于,所述处理器,还用于:The apparatus according to claim 9, wherein the processor is further configured to:
    控制所述第一滤波器,对大于对应阈值的感知信号能量进行滤除处理。The first filter is controlled to filter out the energy of the sensing signal greater than the corresponding threshold.
  11. 根据权利要求10所述的装置,其特征在于,所述滤波器为陷波滤波器。The apparatus of claim 10, wherein the filter is a notch filter.
  12. 根据权利要求11所述的装置,其特征在于,所述处理器,用于:The apparatus of claim 11, wherein the processor is configured to:
    基于大于对应阈值的感知信号能量,确定所述第一滤波器的目标深度;determining the target depth of the first filter based on the perceptual signal energy greater than the corresponding threshold;
    控制具有所述目标深度的第一滤波器对所述大于对应阈值的感知信号能量进行滤除处理。The first filter with the target depth is controlled to perform filtering processing on the perceptual signal energy greater than the corresponding threshold.
  13. 根据权利要求12所述的装置,其特征在于,所述处理器,用于:The apparatus of claim 12, wherein the processor is configured to:
    确定大于对应阈值的感知信号能量的倒数,作为所述第一滤波器的目标深度。The inverse of the perceptual signal energy greater than the corresponding threshold is determined as the target depth of the first filter.
  14. 根据权利要求9-13中任一项所述的装置,其特征在于,所述受无人机的螺旋桨振动影响的时域感知信号包括惯性测量单元检测信号。The device according to any one of claims 9-13, wherein the time-domain perception signal affected by the vibration of the propeller of the drone comprises an inertial measurement unit detection signal.
  15. 根据权利要求9所述的装置,其特征在于,所述处理器,用于:The apparatus of claim 9, wherein the processor is configured to:
    对所述时域感知信号进行离散傅里叶变换,以得到感知信号频率与感知信号能量的对应关系。Discrete Fourier transform is performed on the time-domain sensing signal to obtain the corresponding relationship between the frequency of the sensing signal and the energy of the sensing signal.
  16. 根据权利要求9所述的装置,其特征在于,所述处理器,用于:The apparatus of claim 9, wherein the processor is configured to:
    获取受无人机的螺旋桨振动影响的时域感知信号的采集频率;Obtain the acquisition frequency of the time-domain perception signal affected by the propeller vibration of the drone;
    获取预设采集时长;Get the preset collection time;
    在所述预设采集时长内按照所述采集频率,采集所述时域感知信号。The time domain sensing signal is collected according to the collection frequency within the preset collection time period.
  17. 一种可移动平台,其特征在于,包括:A movable platform, characterized in that, comprising:
    机体;body;
    动力系统,设于所述机体,所述动力系统用于为所述可移动平台提供动力;a power system, arranged on the body, the power system is used to provide power for the movable platform;
    以及权利要求9-16中任意一项所述的滤波装置,所述滤波装置设置于所述机体上。and the filtering device according to any one of claims 9-16, wherein the filtering device is arranged on the body.
  18. 一种计算机可读存储介质,其特征在于,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于实现权利要求1-8中任一项所述的滤波方法。A computer-readable storage medium, characterized in that the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement any one of claims 1-8 The filtering method described in item.
PCT/CN2021/078489 2021-03-01 2021-03-01 Filtering method and apparatus, movable platform, and storage medium WO2022183326A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2021/078489 WO2022183326A1 (en) 2021-03-01 2021-03-01 Filtering method and apparatus, movable platform, and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2021/078489 WO2022183326A1 (en) 2021-03-01 2021-03-01 Filtering method and apparatus, movable platform, and storage medium

Publications (1)

Publication Number Publication Date
WO2022183326A1 true WO2022183326A1 (en) 2022-09-09

Family

ID=83153723

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/078489 WO2022183326A1 (en) 2021-03-01 2021-03-01 Filtering method and apparatus, movable platform, and storage medium

Country Status (1)

Country Link
WO (1) WO2022183326A1 (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104468427A (en) * 2014-10-25 2015-03-25 哈尔滨工业大学 Signal efficient sampling and reconstruction method based on FRI time-frequency domain comprehensive analysis
CN105228054A (en) * 2015-10-15 2016-01-06 深圳市大疆创新科技有限公司 Flight instruments, filming apparatus and recording denoising device thereof and method
CN106874872A (en) * 2017-02-16 2017-06-20 武汉中旗生物医疗电子有限公司 Industrial frequency noise filtering device and method
CN111628790A (en) * 2020-05-28 2020-09-04 成都天奥信息科技有限公司 High-precision anti-interference method and device based on interference bandwidth detection
CN112242145A (en) * 2019-07-17 2021-01-19 南京人工智能高等研究院有限公司 Voice filtering method, device, medium and electronic equipment

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104468427A (en) * 2014-10-25 2015-03-25 哈尔滨工业大学 Signal efficient sampling and reconstruction method based on FRI time-frequency domain comprehensive analysis
CN105228054A (en) * 2015-10-15 2016-01-06 深圳市大疆创新科技有限公司 Flight instruments, filming apparatus and recording denoising device thereof and method
CN106874872A (en) * 2017-02-16 2017-06-20 武汉中旗生物医疗电子有限公司 Industrial frequency noise filtering device and method
CN112242145A (en) * 2019-07-17 2021-01-19 南京人工智能高等研究院有限公司 Voice filtering method, device, medium and electronic equipment
CN111628790A (en) * 2020-05-28 2020-09-04 成都天奥信息科技有限公司 High-precision anti-interference method and device based on interference bandwidth detection

Similar Documents

Publication Publication Date Title
KR102322485B1 (en) Steering control apparatus and steering control method
CN104859715A (en) Hands on steering wheel detect
DE112012006170T5 (en) Motor driving device
JP6243279B2 (en) Driving force control device for electric vehicle
WO2022183326A1 (en) Filtering method and apparatus, movable platform, and storage medium
WO2018095159A1 (en) Unmanned aerial vehicle and control method therefor
KR20170069061A (en) Steering control apparatus and steering control method
CN105897110A (en) Proportional integral (PI) parameter setting method for high-performance controller of permanent-magnet synchronous motor
CN110596583A (en) Variable frequency motor stator fault detection system based on zero sequence voltage analysis and detection method thereof
JP6118988B2 (en) Motor drive device
CN110596458A (en) DEMON spectrum harmonic line spectrum and fundamental frequency automatic estimation method
Kothari et al. Fractional-order models of time delay systems using Walsh operational matrices
Man et al. Design of linear regulators optimal for time-multiplied performance indices
CN107224284A (en) The noise detecting method and system of a kind of digital electrocardiosignal
JP2007020297A (en) System identification equipment and method
JP5919203B2 (en) Automatic steering device
JP4148215B2 (en) Vibration suppression control device for electric motor drive vehicle
JP2010022132A5 (en)
CN113459830B (en) Vehicle shake suppression method and device, electronic equipment and computer storage medium
US9909872B2 (en) Systems and methods for inertial reference system alignment
Khan et al. Real time performance investigation of an intelligent controller based speed control of induction motor drives
JP6863818B2 (en) Position control device
CN111900952A (en) Signal filtering and denoising method and device and storage medium
US11009957B2 (en) Haptic device operation
WO2023171122A1 (en) Motor control device, and automatic adjustment method for same

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: 21928417

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: 21928417

Country of ref document: EP

Kind code of ref document: A1