CN112923894A - Mechanical angle automatic calibration method applied to holder - Google Patents

Mechanical angle automatic calibration method applied to holder Download PDF

Info

Publication number
CN112923894A
CN112923894A CN202110084982.7A CN202110084982A CN112923894A CN 112923894 A CN112923894 A CN 112923894A CN 202110084982 A CN202110084982 A CN 202110084982A CN 112923894 A CN112923894 A CN 112923894A
Authority
CN
China
Prior art keywords
angle
mechanical
mechanical angle
zero
calibration
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110084982.7A
Other languages
Chinese (zh)
Other versions
CN112923894B (en
Inventor
刘坤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Xi'an Innno Aviation Technology Co ltd
Original Assignee
Xi'an Innno Aviation Technology Co ltd
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 Xi'an Innno Aviation Technology Co ltd filed Critical Xi'an Innno Aviation Technology Co ltd
Priority to CN202110084982.7A priority Critical patent/CN112923894B/en
Publication of CN112923894A publication Critical patent/CN112923894A/en
Application granted granted Critical
Publication of CN112923894B publication Critical patent/CN112923894B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

The invention provides an automatic calibration method of mechanical angles applied to a holder, which simplifies, automates and keys the complicated process of the existing holder calibration, and can effectively improve the calibration parameter accuracy and index consistency of holder production, eliminate personal experience factors and improve the production efficiency and yield through an upper computer software monitoring interface and a matched singlechip program; after the automatic calibration process of the cradle head is started, the power supply voltage and the data of the inertia measurement unit are detected, so that the structural part damage caused by abnormal calibration and out-of-control motor due to insufficient power supply is effectively prevented; setting an upper limit mechanical angle, a lower limit mechanical angle, an actual measurement stroke and a calculation zero position corresponding to a zero degree mechanical angle; the correction of zero position calculation is completed through an amplitude convergence algorithm, the automatic calibration method can avoid the inaccuracy of boundary detection caused by the difference of empirical torque and empirical time during manual operation, and the calibration precision and the calibration efficiency of the mechanical angle of each shaft are ensured.

Description

Mechanical angle automatic calibration method applied to holder
Technical Field
The invention relates to the technical field of unmanned aerial vehicle cloud platforms, in particular to a mechanical angle automatic calibration method applied to a cloud platform.
Background
The servo control of the holder needs to use the mechanical angle of each shaft as the input of a rotation matrix, because of the randomness when the motor magnetic steel and the angle sensor are assembled, the mechanical angle of the holder which is not calibrated can not be used as the direct input of the rotation matrix, a series of calibrations need to be carried out on the mechanical angle of the holder, and the calibration accuracy directly influences the control precision of the holder, so the mechanical angle calibration of the holder is the problem to be solved in the production and debugging process.
The traditional calibration method mostly adopts a mode of tool cooperation and manual operation, however, the precision of the calibration method has higher requirements on the design level of the tool, and meanwhile, the calibration method depends on the personal experience of operators, the discreteness of the calibration precision is larger, the consistency of products cannot be improved, the yield is low, and the large-scale production is not facilitated.
Disclosure of Invention
Aiming at the problems that the calibration method in the prior art mostly adopts the mode of tool cooperation and manual operation, which has larger calibration precision discreteness and can not improve the consistency of products, the invention provides the automatic calibration method of the mechanical angle applied to the cloud deck.
The invention is realized by the following technical scheme:
a mechanical angle automatic calibration method applied to a holder comprises the following steps:
step 1, upper computer software receives a calibration instruction to start an automatic calibration process for a holder;
step 2, in the automatic calibration process, calculating the mechanical stroke of the current shafting in the cradle head according to the upper limit mechanical angle and the lower limit mechanical angle set by the current shafting for the cradle head;
step 3, after the mechanical stroke of the current shafting of the holder is obtained, applying zero electrical angle vector voltage to a current detection shafting motor, reading the output of an angle sensor, recording the output as electrical angle offset, and subtracting the electrical angle offset from the electrical angle when the motor is driven to finish electrical angle alignment;
step 4, sweeping the current shafting back and forth at a constant speed, recording an upper limit actual measurement angle and a lower limit actual measurement angle, calculating an actual measurement stroke, and calculating a calculation zero position corresponding to a zero mechanical angle by a linear alignment method;
step 5, controlling an inner frame motor of the holder to be kept at a calculation zero position, controlling an outer frame motor of the holder to perform continuous reciprocating sweeping action, correcting the calculation zero position of the inner frame motor of the holder, setting completion time, stopping calibration when the calculation zero position correction is not completed within the set completion time, and sending error type codes to upper computer software; when the zero correction is completed within the set completion time, all shafting are respectively executed according to the steps 2 to 5 and the calibration is completed, then the step 6 is executed;
step 6, controlling each shaft to be kept at the correction calculation zero position, automatically checking the position precision, and if the precision is qualified, successfully calibrating and executing the operation of the step 7;
and 7, writing the holder calibration parameters into the microcontroller for storage, completing the automatic calibration action of the mechanical angle of the holder, and restarting the equipment.
Preferably, in step 1, after the cradle head starts the automatic calibration process, the power supply voltage and the data of the inertial measurement unit are detected.
Preferably, in step 2, the upper limit mechanical angle is set to a positive value, and the lower limit mechanical angle is set to a negative value; the theoretical mechanical travel of each axis is calculated as follows:
AT＝|Am-A-n|；
wherein A isTTheoretical mechanical stroke; a. themUpper mechanical angle; a. the-nThe lower mechanical angle is.
Preferably, in step 4, the actual measurement stroke is calculated as follows:
AT′＝|Am′-A-n′|；
wherein A isT' is the actual measurement stroke; a. them' is the upper practical angle; a. the-n' is a lower limit actual angle.
Preferably, in step 4, the calculation zero position corresponding to the mechanical angle of zero degree is calculated as follows:
Figure BDA0002910259700000031
wherein A is0To calculate the zero position; a. theTTheoretical mechanical stroke; a. the-nA lower mechanical angle; a. theT' is the actual measurement stroke; a. the-n' is a lower limit actual angle.
Preferably, in step 5, a reciprocating projection component is formed in the direction of the inner frame of the pan/tilt head, and the amplitude variation of the projection component is counted to control the inner frame motor of the pan/tilt head to perform zero position calculation correction.
Preferably, in step 5, when the zero position is corrected and calculated, the inner frame motor of the pan/tilt is controlled to be kept at the zero position, then the outer frame motor of the pan/tilt is controlled to continuously sweep, the quadrature axis component in the outer frame rotating shaft direction of the pan/tilt is measured by using the inertia measurement unit, and the quadrature axis component calculation formula is as follows:
Aq＝A×sin θ；
wherein A isqIs the quadrature component amplitude; a is a sweep amplitude; theta is the angle of the null error.
Further, when the angle theta of the zero error is less than 5 degrees, linear processing is carried out on the sine function, the sweep amplitude is a fixed value, and the angle theta of the zero error and the quadrature component amplitude A areqThere is an approximately linear relationship, and the calculation formula is as follows:
θ＝K×Aq；
wherein θ is the zero error; k is a theoretical conversion coefficient; a. theqIs the quadrature component amplitude.
Compared with the prior art, the invention has the following beneficial technical effects:
the invention provides an automatic mechanical angle calibration method applied to a holder, which simplifies, automates and keys the complex process of the existing holder calibration, and normally, an operator only needs to start a calibration process, observe a monitoring interface of an upper computer and automatically restart the upper computer after the calibration process is finished by monitoring the interface and a matched single chip microcomputer program through upper computer software, wherein the time consumed by the automatic calibration process is about 25-40 seconds, and the calibration precision is approved by a production line; the calibration parameter accuracy and index consistency of the cradle head production can be effectively improved, personal experience factors are eliminated, and the production efficiency and the yield are improved; after the automatic calibration process of the cradle head is started, the power supply voltage and the data of the inertia measurement unit are detected, so that the structural part damage caused by abnormal calibration and out-of-control motor due to insufficient power supply is effectively prevented; by setting the upper limit mechanical angle, the lower limit mechanical angle, the actual measurement stroke and the calculation zero position corresponding to the zero degree mechanical angle, the calibration efficiency of the theoretical mechanical stroke of each shaft is ensured, and the inaccuracy of boundary detection caused by the difference of the empirical torque and the empirical time during manual operation is avoided.
Drawings
FIG. 1 is a schematic view of an upper computer connecting pan/tilt head according to the present invention;
FIG. 2 is a flow chart of the mechanical angle automatic calibration method applied to the pan/tilt head according to the present invention;
FIG. 3 is a schematic view of the sweep boundary detection in the present invention;
FIG. 4 is a schematic diagram of the convergence algorithm correcting the calculated zero position in the present invention.
In the figure: 1-upper computer software; and 2-a tripod head.
Detailed Description
The present invention will now be described in further detail with reference to specific examples, which are intended to be illustrative, but not limiting, of the invention.
According to the method for automatically calibrating the mechanical angle applied to the holder, disclosed by the invention, as shown in figure 1, after upper computer software 1 is connected with a holder 2 through a USB virtual serial port, the method for automatically calibrating the mechanical angle is carried out, and as shown in figure 2, the method comprises the following steps:
step 1, upper computer software 1 receives a calibration instruction to start an automatic calibration process for a holder 2;
step 2, in the automatic calibration process, calculating the mechanical stroke of the current shafting in the cradle head 2 according to the upper limit mechanical angle and the lower limit mechanical angle set by the current shafting for the cradle head 2;
step 3, after the mechanical stroke of the current shafting of the holder is obtained, applying zero electrical angle vector voltage to a current detection shafting motor, reading the output of an angle sensor, recording the output as electrical angle offset, and subtracting the electrical angle offset from the electrical angle when the motor is driven to finish electrical angle alignment;
step 4, sweeping the current shafting back and forth at a constant speed, recording an upper limit actual measurement angle and a lower limit actual measurement angle, calculating an actual measurement stroke, and calculating a calculation zero position corresponding to a zero mechanical angle by a linear alignment method;
step 5, controlling an inner frame motor of the holder 2 to be kept at a calculation zero position, controlling an outer frame motor of the holder 2 to perform continuous reciprocating sweeping action, correcting the calculation zero position of the inner frame motor of the holder 2, setting completion time, stopping calibration when the calculation zero position correction is not completed within the setting completion time, and sending error type codes to the upper computer software 1; when the zero correction is completed within the set completion time, all shafting are respectively executed according to the steps 2 to 5 and the calibration is completed, then the step 6 is executed;
step 6, controlling each shaft to be kept at the correction calculation zero position, automatically checking the position precision, and if the precision is qualified, successfully calibrating, and performing the operation of step 7;
and 7, writing the calibration parameters of the holder 2 into the microcontroller for storage, completing the automatic calibration action of the mechanical angle of the holder, and restarting the equipment.
In the step 1, after the automatic calibration process is started for the holder 2, the power supply voltage and the data of the inertia measurement unit are detected.
In the step 2, setting a positive value for the upper limit mechanical angle and a negative value for the lower limit mechanical angle; the theoretical mechanical travel of each axis is calculated as follows:
AT＝|Am-A-n|；
wherein A isTTheoretical mechanical stroke; a. themUpper mechanical angle; a. the-nThe lower mechanical angle is.
In step 4, the actual measurement travel is calculated as follows:
AT′＝|Am′-A-n′|；
wherein A isTTheoretical mechanical stroke; a. themUpper mechanical angle; a. the-nThe lower mechanical angle is.
The calculation zero position corresponding to the mechanical angle of zero degree is calculated as follows:
Figure BDA0002910259700000051
wherein A is0To calculate the zero position; a. theTTheoretical mechanical stroke; a. the-nA lower mechanical angle; a. theT' is the actual measurement stroke; a. the-n' is a lower limit actual angle.
And 5, forming a reciprocating projection component in the direction of the inner frame of the holder 2, and controlling an inner frame motor of the holder 2 to calculate zero correction by counting the amplitude change of the projection component.
In step 5, the inner frame motor of the holder 2 is controlled to be kept at the calculation zero position, the outer frame motor of the holder 2 is controlled to perform continuous reciprocating sweeping motion, the inertial measurement unit is used for detecting the sweeping motion, ideally, the sweeping motion does not generate a projection component in the inner frame direction, but due to the existence of zero position calculation error, a reciprocating projection component is actually generated in the inner frame direction, an angle is corrected by counting the amplitude change of the projection component in the direction capable of enabling the amplitude to be converged by controlling the inner frame motor, the angle is in direct proportion to the amplitude of the projection component, and the theoretical zero position of the inner frame motor is corrected by repeatedly analyzing and correcting. If the time exceeds 20 seconds and zero correction cannot be completed, the calibration is stopped, and an error type code is uploaded to upper computer software.
The automatic calibration method automatically calculates the motion parameters of the calibration action, after the validity of the inertia measurement unit and the execution mechanism is checked, the calibration action is executed according to the calculated motion parameters, when the inertia measurement unit and the execution mechanism are swept to a motion boundary at a constant speed, the motor is automatically controlled to output uniform torque, the uniform torque is kept for a uniform time at the boundary to check the validity of a boundary angle, and the inaccuracy of boundary detection caused by the difference of empirical torque and empirical time during manual operation is avoided; when the convergence algorithm is used for correcting the zero calculation of the inner frame, the program controls the outer frame to perform continuous swinging and sweeping actions, controls the inner frame to perform a convergence direction test near the zero calculation position, and corrects the zero calculation position in a stepping fine adjustment mode after the convergence direction is determined, so that the discreteness of zero error caused by zero searching jig precision and personal experience is avoided.
According to fig. 3, when detecting the sweeping boundary, the motor needs to be subjected to motion detection and stop detection, the motion detection is used for judging that the motor starts to rotate, and the stop detection is used for judging that the motor stops rotating, and the specific method is as follows: controlling a motor to rotate at a constant speed in the forward direction, continuously detecting the variation of the actually measured angle at the front moment and the rear moment in the rotating process, and judging that the motor is in a motion state if the variation is continuously greater than a threshold value and exceeds a specified number of times; continuously detecting the variation of the actually measured angle at the front moment and the back moment, wherein the variation is continuously smaller than the threshold value and exceeds the specified times, and judging that the motor is in a stop state; and then controlling the motor to rotate reversely, and carrying out boundary detection on the other side according to the above mode. The method can guarantee the consistency of output torque and the consistency of residence time, and further guarantee the consistency of equipment calibration.
According to fig. 4, when the calculation zero position is corrected, the inner frame motor of the pan/tilt head 2 is controlled to be kept at the calculation zero position, then the outer frame motor of the pan/tilt head 2 is controlled to continuously sweep, the quadrature axis component in the outer frame rotating shaft direction of the pan/tilt head 2 is measured by using the inertia measurement unit, and the quadrature axis component calculation formula is as follows:
Aq＝A×sin θ；
wherein A isqIs the quadrature component amplitude; a is a sweep amplitude; theta is the angle of the zero error;
when the angle theta of the zero error is less than 5 degrees, linear processing is carried out on the sine function, the sweep amplitude is a fixed value, and the angle theta of the zero error and the quadrature component amplitude A areqThere is an approximately linear relationship, and the calculation formula is as follows:
θ＝K×Aq；
wherein θ is the zero error; k is a theoretical conversion coefficient; a. theqIs the quadrature component amplitude.
Selecting a correction conversion coefficient K 'when zero error correction is carried out'<Calculating a correction error theta 'by theoretical conversion coefficient K, controlling the inner frame to offset the correction error theta' on the basis of calculating zero position, and then counting quadrature component amplitude AqThus correcting the zero bit error several times. When the initial null error correction is performed, since the null error direction is unknown, the correction is performed by assuming the forward direction and the convergence method is performedAnd (4) performing negative correction if the quadrature component amplitude is not converged as shown in fig. 4, and continuously correcting the zero error after the convergence direction is confirmed until the quadrature component amplitude is converged to the minimum, and considering that the zero error correction is finished. The method can guarantee the accuracy and convenience of zero error correction operation.
According to the invention, the upper computer software 1 monitors an interface, the cradle head 2 is controlled to start a set of automatic calibration method for internal solidification, the automatic calibration method can carry out stages of a complex process of calibrating the cradle head 2, each stage can upload a current calibration result after being executed, auxiliary data and curves are provided to help an operator to position a calibration progress and result, and the cradle head 2 completes a set of actions of parameter calculation, mechanical movement, parameter updating, storage and restarting according to a flow specified by an automatic calibration program.
Examples
Calibrating the first cradle head to be tested and the second cradle head to be tested by using a mechanical angle automatic calibration method of the cradle head, taking the calibration of a pitch axis as an example, and starting an automatic calibration process for the cradle head 2 by receiving a calibration instruction through upper computer software 1; in the automatic calibration process, the upper limit mechanical angle set on the first pan-tilt is 100 degrees and the lower line mechanical angle is-105 degrees; the upper limit mechanical angle of the second tripod head is 100 degrees, the lower line mechanical angle is-105 degrees, and the theoretical stroke of the first tripod head is calculated to be 205 degrees; the theoretical stroke of the second tripod head is 205 degrees; after mechanical strokes of all shafts in the first cloud platform and the second cloud platform are respectively obtained, applying zero electrical angle vector voltage to current detection shafting motors of the first cloud platform and the second cloud platform, reading the output of an angle sensor, and recording the zero electrical angle vector voltage as electrical angle offset, wherein the zero electrical angle offset of the first cloud platform and the zero electrical angle offset of the second cloud platform are respectively 16538 and 18285, and when the motors are driven, subtracting the electrical angle offset from the electrical angle to complete electrical angle alignment;
sweeping the current shafting back and forth at a constant speed, and recording an upper limit actual measurement angle and a lower limit actual measurement angle of the first tripod head as 15495 and 202163 respectively; recording an upper limit actual measurement angle and a lower limit actual measurement angle of the second holder as 25638 and 211376 respectively, calculating to obtain that actual measurement strokes of the first holder and the second holder are 186668 and 185738 respectively, and calculating zero positions corresponding to zero-degree mechanical angles of the first holder and the second holder as 106552 and 116242 respectively by a linear alignment method;
controlling inner frame motors of the first pan-tilt and the second pan-tilt to be kept at the calculation zero positions, controlling outer frame motors of the first pan-tilt and the second pan-tilt to perform continuous reciprocating sweeping actions, and correcting theoretical zero positions of the inner frame motors of the first pan-tilt and the second pan-tilt through a convergence algorithm to obtain correction zero positions of the first pan-tilt and the second pan-tilt of 107042 and 115176 respectively; the upper limit setting completion time is 20 seconds, when the zero correction is not completed in the setting completion time, the calibration is stopped, and an error type code is sent to the upper computer software 1; when the zero correction is completed within the set completion time;
after the calibration of all shafting is finished, controlling each shaft to be kept at a correction calculation zero position, automatically checking the position precision, if the precision is qualified, successfully calibrating, and storing the calibration parameters; the calibration parameters of the first cloud platform and the second cloud platform are written into the microcontroller for storage, so that the calibration parameters can be directly read and used when the system is started next time, the automatic calibration action of the mechanical angle of the cloud platforms is completed, the equipment is restarted, and the calibration statistics of the pitching axes of the first cloud platform and the second cloud platform are shown in table 1.
Item First cloud platform Second tripod head
Upper limit mechanical angle 100° -105°
Upper limit ofMechanical angle 100° -105°
Theoretical mechanical stroke 205° 205°
Zero electrical angle offset -16538 -18285
Upper limit actual measurement angle 15495 25638
Lower limit actual measurement angle 202163 211376
Resolving the journey 186668 185738
Computing zero position 106552 116242
Correcting zero position 107042 115176
Correcting upper limit mechanical angle -100.58° -98.37°
Correcting lower limit mechanical angle 104.50° 105.69°
Table 1 statistics of the pitch axis calibration of the first and second pan/tilt.

Claims (8)

1. The automatic mechanical angle calibration method applied to the holder is characterized by comprising the following steps of:
step 1, upper computer software (1) receives a calibration instruction to start an automatic calibration process for a cradle head (2);
step 2, in the automatic calibration process, calculating the mechanical stroke of the current shafting in the cradle head (2) according to the upper limit mechanical angle and the lower limit mechanical angle set by the current shafting for the cradle head (2);
step 3, after the mechanical stroke of the current shafting of the holder is obtained, applying zero electrical angle vector voltage to a current detection shafting motor, reading the output of an angle sensor, recording the output as electrical angle offset, and subtracting the electrical angle offset from the electrical angle when the motor is driven to finish electrical angle alignment;
step 4, sweeping the current shafting back and forth at a constant speed, recording an upper limit actual measurement angle and a lower limit actual measurement angle, calculating an actual measurement stroke, and calculating a calculation zero position corresponding to a zero mechanical angle by a linear alignment method;
step 5, controlling an inner frame motor of the holder (2) to be kept at a calculation zero position, controlling an outer frame motor of the holder (2) to perform continuous reciprocating sweeping action, correcting the calculation zero position of the inner frame motor of the holder (2), setting completion time, stopping calibration when the calculation zero position correction is not completed within the setting completion time, and sending error type codes to the upper computer software (1); when the zero correction is completed within the set completion time, all shafting are respectively executed according to the steps 2 to 5 and the calibration is completed, then the step 6 is executed;
step 6, controlling each shaft to be kept at the correction calculation zero position, automatically checking the position precision, and if the precision is qualified, successfully calibrating and executing the operation of the step 7;
and 7, writing the calibration parameters of the holder (2) into the microcontroller for storage, completing the automatic calibration action of the mechanical angle of the holder, and restarting the equipment.
2. The method for automatically calibrating the mechanical angle applied to the pan/tilt head according to claim 1, wherein in step 1, the power supply voltage and the data of the inertial measurement unit are detected after the pan/tilt head (2) is started up in the automatic calibration process.
3. The automatic calibration method for mechanical angles of a pan/tilt head according to claim 1, wherein in step 2, the upper limit mechanical angle is set to a positive value, and the lower limit mechanical angle is set to a negative value; the theoretical mechanical travel of each axis is calculated as follows:
AT＝|Am-A-n|；
wherein A isTTheoretical mechanical stroke; a. themUpper mechanical angle; a. the-nThe lower mechanical angle is.
4. The method for automatically calibrating a mechanical angle of a pan/tilt head according to claim 1, wherein in step 4, the actual measurement stroke is calculated as follows:
AT′＝|Am′-A-n′|；
wherein A isT' is the actual measurement stroke; a. them' is the upper practical angle; a. the-n' is a lower limit actual angle.
5. The method for automatically calibrating a mechanical angle applied to a pan/tilt head according to claim 1, wherein in step 4, the calculation zero position corresponding to the mechanical angle of zero degree is calculated as follows:
Figure FDA0002910259690000021
wherein A is0To calculate the zero position; a. theTTheoretical mechanical stroke; a. the-nA lower mechanical angle; a. theT' is the actual measurement stroke; a. the-n' is a lower limit actual angle.
6. The method for automatically calibrating the mechanical angle applied to the pan-tilt head according to claim 1, wherein in the step 5, a projection component in a reciprocating manner is formed in the direction of the inner frame of the pan-tilt head (2), and the amplitude change of the projection component is counted to control the inner frame motor of the pan-tilt head (2) to perform the calculation zero correction.
7. The method for automatically calibrating the mechanical angle applied to the pan/tilt head according to claim 1, wherein in step 5, when the zero calculation position is corrected, the inner frame motor of the pan/tilt head (2) is controlled to be kept at the zero calculation position, then the outer frame motor of the pan/tilt head (2) is controlled to continuously sweep, and the inertia measurement unit is used to measure the quadrature component of the outer frame rotating shaft direction of the pan/tilt head (2), wherein the quadrature component calculation formula is as follows:
Aq＝A×sinθ；
wherein A isqIs the quadrature component amplitude; a is a sweep amplitude; theta is the angle of the null error.
8. The method according to claim 7, wherein when the angle θ of the null error is less than 5 °, the sinusoidal function is linearly processed, the sweep amplitude is a fixed value, and the angle θ of the null error and the quadrature component amplitude a are fixed valuesqThere is an approximately linear relationship, and the calculation formula is as follows:
θ＝K×Aq；
wherein θ is the zero error; k is a theoretical conversion coefficient; a. theqIs the quadrature component amplitude.
CN202110084982.7A 2021-01-21 2021-01-21 Mechanical angle automatic calibration method applied to holder Active CN112923894B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110084982.7A CN112923894B (en) 2021-01-21 2021-01-21 Mechanical angle automatic calibration method applied to holder

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110084982.7A CN112923894B (en) 2021-01-21 2021-01-21 Mechanical angle automatic calibration method applied to holder

Publications (2)

Publication Number Publication Date
CN112923894A true CN112923894A (en) 2021-06-08
CN112923894B CN112923894B (en) 2022-11-29

Family

ID=76164351

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110084982.7A Active CN112923894B (en) 2021-01-21 2021-01-21 Mechanical angle automatic calibration method applied to holder

Country Status (1)

Country Link
CN (1) CN112923894B (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108474671A (en) * 2017-11-14 2018-08-31 深圳市大疆创新科技有限公司 Mechanical angle detection method, holder and machine readable storage medium
CN110268357A (en) * 2018-01-19 2019-09-20 深圳市大疆创新科技有限公司 A kind of limit angle calibration method and terminal device
CN110553669A (en) * 2019-09-30 2019-12-10 睿魔智能科技（深圳）有限公司 holder calibration method and calibration system
CN110645891A (en) * 2019-11-04 2020-01-03 重庆市亿飞智联科技有限公司 Motor calibration system, method and device, controller and storage medium
CN111106774A (en) * 2020-01-13 2020-05-05 深圳市星图智控科技有限公司 Calibration method for electrical angle and mechanical angle of foc-driven brushless motor with magnetic encoder
CN111684386A (en) * 2019-05-28 2020-09-18 深圳市大疆创新科技有限公司 Cradle head zero calibration method and cradle head
CN112135124A (en) * 2020-09-24 2020-12-25 苏州科达科技股份有限公司 Method, device and system for calibrating and detecting position of holder

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108474671A (en) * 2017-11-14 2018-08-31 深圳市大疆创新科技有限公司 Mechanical angle detection method, holder and machine readable storage medium
CN110268357A (en) * 2018-01-19 2019-09-20 深圳市大疆创新科技有限公司 A kind of limit angle calibration method and terminal device
CN111684386A (en) * 2019-05-28 2020-09-18 深圳市大疆创新科技有限公司 Cradle head zero calibration method and cradle head
CN110553669A (en) * 2019-09-30 2019-12-10 睿魔智能科技（深圳）有限公司 holder calibration method and calibration system
CN110645891A (en) * 2019-11-04 2020-01-03 重庆市亿飞智联科技有限公司 Motor calibration system, method and device, controller and storage medium
CN111106774A (en) * 2020-01-13 2020-05-05 深圳市星图智控科技有限公司 Calibration method for electrical angle and mechanical angle of foc-driven brushless motor with magnetic encoder
CN112135124A (en) * 2020-09-24 2020-12-25 苏州科达科技股份有限公司 Method, device and system for calibrating and detecting position of holder

Also Published As

Publication number Publication date
CN112923894B (en) 2022-11-29

Similar Documents

Publication Publication Date Title
CN111185901A (en) Robot device
CN114485488B (en) Automatic measurement system and measurement method for exhaust area of turbine guider
CN110370271B (en) Joint transmission ratio error calibration method of industrial series robot
US11289303B2 (en) Calibrating method and calibrating system
CN114926507A (en) Pole piece deviation rectifying method, device and equipment and readable storage medium
CN112923894B (en) Mechanical angle automatic calibration method applied to holder
CN109848989A (en) A kind of robot execution end automatic Calibration and detection method based on ruby probe
EP1886771B1 (en) Rotation center point calculating method, rotation axis calculating method, program creating method, operation method, and robot apparatus
CN114800542B (en) Spiral bevel gear full-angle flexible polishing machine device, polishing method and system
CN110686655A (en) Positioning method, device and system for three-dimensional curved surface workpiece
CN114253217B (en) Automatic calibration method for RTCP (real-time control protocol) of five-axis machine tool with self-correcting function
CN113814870B (en) Method for measuring and calculating pose of magnetorheological polished workpiece and polishing method
US11721573B2 (en) Method and apparatus for detecting positions of wafers
CN114012719A (en) Zero calibration method and system for six-axis robot
CN109299515A (en) One kind is extracted based on installation error and modified workpiece machining error analysis method
WO2022025059A1 (en) Robot system
CN207850675U (en) A kind of test device of knob feel
CN116295196A (en) Automatic measurement method for twisted and deformed blade
CN112378558B (en) Method for measuring eccentric moment of servo platform
CN113126594B (en) Satellite autonomous fault diagnosis method for double-freedom-degree solar wing driving mechanism
CN108592838B (en) Calibration method and device of tool coordinate system and computer storage medium
CN112355712A (en) Trigger type on-machine measurement precision calibration method and system
CN114485386A (en) Method, device and system for calibrating workpiece coordinate system
CN115452028B (en) Sensor calibration method, system, operation machine and electronic equipment
CN113043264A (en) Zero calibration method for integrated joint seven-axis robot

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant