CN102538726A - System and method for testing position and posture of target by using electronic theodolite - Google Patents

System and method for testing position and posture of target by using electronic theodolite Download PDF

Info

Publication number
CN102538726A
CN102538726A CN2010105813039A CN201010581303A CN102538726A CN 102538726 A CN102538726 A CN 102538726A CN 2010105813039 A CN2010105813039 A CN 2010105813039A CN 201010581303 A CN201010581303 A CN 201010581303A CN 102538726 A CN102538726 A CN 102538726A
Authority
CN
China
Prior art keywords
transit
attitude
auxiliary
coordinate
coordinate system
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN2010105813039A
Other languages
Chinese (zh)
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.)
Beijing Forestry University
Original Assignee
Beijing Forestry University
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 Beijing Forestry University filed Critical Beijing Forestry University
Priority to CN2010105813039A priority Critical patent/CN102538726A/en
Publication of CN102538726A publication Critical patent/CN102538726A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Length Measuring Devices By Optical Means (AREA)

Abstract

The invention discloses a system and method for testing the position and the posture of a target by using an electronic theodolite. The system comprises the electronic theodolite, an auxiliary coordinate device and data processing algorithms, wherein the electronic theodolite is used for determining an angle of the tested target, the auxiliary coordinate device serves as a reference coordinate system of the electronic theodolite, and the determined angle information is transferred to a computer and is automatically resolved by the data processing algorithms in the computer. The method is characterized in that: the electronic theodolite is dispensable of being leveled during the process of testing, an x axis and a y axis are always horizontal and a z axis is always vertical in the coordinate system formed by the auxiliary coordinate device, and the fast determination of the positions and the postures of accessible and inaccessible targets can be achieved by using a single theodolite. The system and method for testing the position and the posture of the target by using the electronic theodolite can be applied to the testing of the motion accuracy of robots, the testing of tree height, tree diameter and canopy breadth in the field of forestry, and the testing in the building industry. The theodolite is dispensable of being leveled in virtue of the auxiliary coordinate device, a leveling mechanism in the theodolite can be removed, therefore, the cost for equipment is lowered; and data are automatically stored and resolved by the computer, so that the testing accuracy is improved, the labor intensity in work is lowered, and the working efficiency is increased.

Description

A kind of electronic theodolite is confirmed the test macro and the method for application thereof of object position and attitude
One, technical field
The present invention system confirms the test macro and the method for application thereof of object position or attitude about a kind of transit; Be mainly used in field of forestry and confirm the position of accessible point and unreachable point; Can be used for the kinematic accuracy that the robot field measures the mechanical arm end effector simultaneously, and other is applied to the industry and the field of transit.
Two, background technology
Up to the present, also do not see transit can be used for confirming object position or pose without leveling relevant report or document.Spirit-leveling instrument, transit and total powerstation must flatten before test, centering; During field work; Receive landform and surface geology condition effect; Leveling is loaded down with trivial details consuming time with centering, and possibly influence soft owing to ground or other factors cause the pose state of testing tool coordinate system to change in the test process, can influence the measuring accuracy of object position or attitude inevitably.
In field of forestry, for the test of unreachable point, like confirming etc. of the measurement of the height of tree, fire location, adopt usually: height finder is surveyed high; Transit cooperates employing triangulated height method to carry out height of tree measurement with tape measure and scale; Adopt total powerstation not have prism and survey method; Experience estimation method etc.Its defective is:
Adopt height finder, must at first know the horizontal range of height finder, or press close to the winning post etc. of the perpendicular fixed length (general 2 or 3 meters) in trunk place, be difficult in the forest zone of circumstance complication even can't implement at all, be unfavorable for the raising of work efficiency to measured object;
1. cooperate by transit, tape measure and scale, when application triangulated height method was measured, because field environment is complicated, the relative position between the transit was difficult to accurately confirm, has limited the use of this method;
2. adopt total powerstation not have prism and survey method; The factor that influences its measuring accuracy has that the contrast between the surface nature of measured object, target and the background is little, near the band coloured light other body surface of target proximity, collimation line or the angle of reverberation, measuring beam and reflecting surface etc.; Especially unopen location and dense vegetation are regional in the visual field, and the application of this kind method receives very big restriction;
3. experience estimation method, error is big and do not have a corresponding bearing calibration.
Publication number is that the patent of CN 101021416A patent by name " method for measuring tree height by total station instrument " discloses a kind of method that measures the height of tree, and this method system is employed in the real-time measurement that same vertical guide is settled the method realization height of tree that total powerstation and total powerstation cross for twice.The prerequisite of implementing this method is that the total powerstation of twice arrangement must be remained in the same vertical guide, and practical implementation is difficulty comparatively, needs the leveling total powerstation simultaneously twice, can't increase work efficiency in the field environment of complicacy.
Publication number discloses a kind of method of measuring unreachable some three-dimensional coordinate for the patent of CN101776446A patent " a kind of omnidirectional conductor rod cooperates total powerstation to measure unreachable some three-dimensional coordinate method " by name; This method ties up to any three points and settles omnidirectional conductor rod respectively and point to unreachable point; Article three, the intersection point of space line is unreachable point, confirms this point coordinate with this.The problem that this method exists is that omnidirectional conductor rod is difficult to accurately aim at unreachable point; The position and attitude error of three bars is the measurement accuracy of the unreachable point coordinate value of influence directly; Finally cause accurately to confirm the position that to put; Simultaneously confirm the determined straight line of omnidirectional bar because of the need triplicate, work efficiency has much room for improvement.
In the kinematic accuracy test or similar measurement of the end effector of robot; Mainly still adopt the transit system that crosses; The total powerstation polar coordinate system; The problem that the transit system that crosses exists is relative position relation between a plurality of transits through taking aim at mutually or bundle adjustment is accomplished, and the total powerstation distance accuracy is lower, influences the precision of system.Similarly sextuple laser tracker is also adopted in measurement now; Three-dimensional laser scanning system, gage beam systems etc. are although these several kinds of measuring systems can provide very accurate dynamic and static coordinate and measurement of angle; But price is very expensive, is difficult to be applied to field of forestry simultaneously.
Therefore, how to improve measurement accuracy, reduction equipment and measurement cost better adapt to complex environment, improve the automatization level that measures, and reduce workload, become a problem demanding prompt solution.
Three, summary of the invention
The present invention aims to provide a kind of pair warp and weft appearance that need not and flattens measurement system and the method for application thereof that can confirm the position and the attitude of measured target thing with centering.
One of target of the present invention is that a kind of auxiliary coordinate device is provided; This apparatus features is that it can form a three-dimensional system of coordinate; This coordinate system makes so because of the structure of this system; No matter where this device is placed, two coordinate axis wherein form a surface level all the time, and another coordinate axis then is in the vertical state all the time.This auxiliary coordinates is used as the reference frame of transit in the measurement process.Should mainly comprise by auxiliary coordinate device: a support frame; Three axles; Two each and every one web members; Five top.
Another target system of the present invention provides a kind of method of utilizing single transit to confirm to reach object position or attitude.This method for measurement can be divided into two kinds of patterns, and promptly transit is in the leveling state and is in two kinds of patterns of non-leveling state.
Another target system of the present invention provides a kind of method of utilizing single transit to confirm unreachable object position or attitude.This method for measurement is suitable for transit and is in the leveling state and is in two kinds of patterns of non-leveling state.
Another target of the present invention system provides a kind of and utilizes two transits to confirm to reach the method with unreachable object position or attitude.This method for measurement is suitable for transit and is in the leveling state and is in two kinds of patterns of non-leveling state.
Transit in this measurement system links to each other with computing machine through data line; The data of surveying pass to computing machine through data line; And be stored in wherein, correlation computations is all implemented to resolve through the existing algorithm routine of computing machine, thereby confirms the position or the attitude of measured target thing.
Four, description of drawings
Fig. 1 is a kind of structural representation of auxiliary coordinate device;
Fig. 2 is a transit survey pose schematic diagram, and it is intended to confirm the transformational relation between transit coordinate system and the servicing unit coordinate system;
Fig. 3 confirms to put on the measured target thing position for transit aim at the mark thing and servicing unit figure for utilizing single transit or two transit, thereby confirms the test synoptic diagram of object position and attitude.
Five, embodiment
Describe embodiments of the invention below with reference to accompanying drawings in detail.Before specifying, this area the stakeholder should be appreciated that, used term can not be confined to general sense or dictionary meanings in this explanation and claims, and should make an explanation according to technological corresponding implication of invention and content.Therefore, the purpose of auxiliary coordinate apparatus structure shown in illustration and the accompanying drawing only is to describe embodiments of the invention in this instructions, and structure shown in being not limited to can change or equivalence replacement and can not depart from spirit of the present invention and scope it.
Fig. 1 is a kind of auxiliary coordinate device, and this auxiliary coordinate device comprises: a support frame 1, and this framework can directly be positioned on the ground, also can link to each other like tripod with other device; Transverse axis 2, this rotating shaft terminal are fixed on the framework 1; One first web member 10 is equipped with bearing between this web member 10 and the axle 2, and web member 10 can freely rotate around transverse axis 2 under action of gravity; One transverse axis 11, it passes web member 10) on two coaxial apertures, and connect firmly with web member 10; One second web member 3, these web member 3 sides have a hole that supplies transverse axis 11 to pass, and its underpart has a screw, between web member 3 and the transverse axis 11 bearing is installed, and web member 3 can freely rotate around transverse axis 11; Vertical axes 4, external thread has been attacked at the two ends of this vertical axes 4, and the threaded portion on these vertical axes 4 tops is threaded with screw in web member 3 bottoms; One three shaft coupling piece 12; This three shaft coupling piece 12 has six smooth flat, and wherein two surfaces are surface level up and down, and all the other four sides are the vertical plane; Each surperficial central authorities is processed with screw, and its upper surface screw supplies the threaded portion of vertical axes 4 bottoms to screw in; Top 5-9; External thread has been attacked in 5 top ends; With three shaft coupling pieces, 12 thread connection, these are top to can be used for finely tuning and makes the upper and lower surface of three shaft coupling pieces be in horizontality all the time, and the axes intersect of these top 5-9 is in a bit simultaneously; Cusp B-E on the top 5-8 forms a plane, and upward the formed plane of cusp B-E is vertical with top 5-8 for top 9 axis.
Can know with reference to Fig. 1; The framework of this backup system is positioned over the formed plane of cusp B-E, any position is always a surface level; Top 9 axis then is always a vertical axes; Simultaneously the upper surface of three shaft coupling pieces is always a surface level, so forms an auxiliary coordinate device that has surface level and vertical axes all the time with regard to the cusp on top capable of using, and the position relation between these cusps is known.Or as shown in Figure 3, confirm that at the upper surface of three connections the position concerns known 3 and forms an auxiliary coordinate device.
(1) first kind of embodiment: single transit is confirmed to reach object position or attitude
Transit is in the leveling state when 1. measuring
As shown in Figure 2, place at the object place one define 3 of 3 O ', A, B on it " ⊥ " shape scale, O ' A ⊥ O ' B wherein, the length of O ' A and O ' B is known.O ' is overlapped with i measured point (object).As shown in Figure 2, make A iWith o ' i, B iWith o ' i, A iWith B iBetween distance be respectively l, m, n, and known.In Fig. 2, h Ai, h Oi, h BiBe respectively A i, o ' iWith B iThe vertical range of surface level xoy is unknown quantity in the transit coordinate system.Transit is aimed at o ' i, A iWith B iHorizontal angle and vertical angle when 3 points, θ, α represent that transit is aimed at wherein, then these 3 coordinates in the transit coordinate system are following:
x Ai = h Ai · ctg α Ai · sin θ Ai y Ai = h Ai · ctg α Ai · cos θ Ai z Ai = - h Ai , x Bi = h Bi · ctg α Bi · sin θ Bi y Bi = h Bi · ctg α Bi · cos θ Bi z Bi = - h Bi , x oi = h oi · ctg α oi · sin θ oi y oi = h oi · ctg α oi · cos θ oi z oi = - h oi
And h Ai, h Oi, h BiThen by
l 2 = ( x Ai - x oi ) 2 + ( y Ai - y oi ) 2 + ( z Ai - z oi ) 2 m 2 = ( x Bi - x oi ) 2 + ( y Bi - y oi ) 2 + ( z Bi - z oi ) 2 n 2 = ( x Bi - x Ai ) 2 + ( y Bi - y Ai ) 2 + ( z Bi - z Ai ) 2
Calculate and get.At last according to mathematical model
o i D T = a 1 a 1 2 + a 2 2 + a 3 2 b 1 b 1 2 + b 2 2 + b 3 2 c 1 c 1 2 + c 2 2 + c 3 2 x oi ′ a 2 a 1 2 + a 2 2 + a 3 2 b 2 b 1 2 + b 2 2 + b 3 2 c 2 c 1 2 + c 2 2 + c 3 2 y oi ′ a 3 a 1 2 + a 2 2 + a 3 2 b 3 b 1 2 + b 2 2 + b 3 2 c 3 c 1 2 + c 2 2 + c 3 2 z oi ′ 0 0 0 1
Wherein,
Figure BSA00000379997800036
Figure BSA00000379997800037
Figure BSA00000379997800038
Can obtain measured target thing place coordinate system according to this 4 * 4 matrix and concern with attitude with position between the transit coordinate system, can obtain the coordinate of measured point O ' in the transit coordinate system thus and be (x ' Oi, y ' Oi, z ' Oi), thereby realize utilizing single transit to confirm the position of measured point.
Transit is in the state of leveling when 2. measuring
As shown in Figure 3, confirmed three known reference point O of good mutual alignment relation on the surface level of auxiliary coordinate device r, A r, B r, and O rA r⊥ O rB r, O rA r, O rB r, A rB rLength known, be respectively l r, m r, n rO r, A r, B rForm a coordinate system.Make O rA rBe x axle, O rB rBe y axle, O rPoint helps coordinate origin for the shop, through O rAnd it is, as shown in Figure 3 perpendicular to the axle location z axle of surface level.
Step 1: will assist the coordinate device to be positioned over and make things convenient for transit to observe part, and aim at three reference point O respectively with transit r, A r, B r, recording three groups of horizontal angles and vertical angle, identical process and mathematical model in the employing 1. can obtain O in the auxiliary coordinate device r, A r, B rPosition and the attitude matrix of the coordinate system of setting up in the transit coordinate system do
Figure BSA00000379997800041
Because the test to object will be benchmark with the auxiliary coordinates all subsequently, therefore need know position and the attitude matrix of transit coordinate system in auxiliary coordinates
Figure BSA00000379997800042
Obviously,
Figure BSA00000379997800043
Step 2: in case after having confirmed the position and attitude relation of transit coordinate system and auxiliary coordinates; Need only transit in the test and do not change the station; Then should concern constant; According to step and method in 1. i measured target point (object) measured subsequently, confirm the position between measured target thing place coordinate system and the transit coordinate system and attitude concerns
Figure BSA00000379997800044
Step 3: confirm position and the attitude
Figure BSA00000379997800045
of measured target point (object) in auxiliary coordinates
The position and the attitude that realize thus not flattening transit and confirm accessible point (object).
(2) second kinds of embodiments: single transit is confirmed unreachable object position or attitude
Whether the method that the present invention proposes does not here do requirement for transit leveling, centering.
Step 1: will assist the coordinate device to be positioned over and make things convenient for transit to observe part, the structure of this auxiliary coordinate device, its coordinate system and symbol wherein are with identical described in (one).As shown in Figure 3, a transit is positioned over A, B two places respectively, the coordinate system of each survey station place transit is respectively O AX AY A, O BX BY B, suppose i measured point C simultaneously iCoordinate in auxiliary coordinates is (x Ci, y Ci, z Ci).The transit that will be in survey station A place is aimed at three reference point O in the auxiliary coordinate device r, A r, B r, utilize the mathematical model in () can obtain the pose matrix of survey station A place transit coordinate system in auxiliary coordinates
Figure 879223DEST_PATH_GSB00000550577500016
Can obtain the transit coordinate origin O of survey station A place thus ACoordinate (x in auxiliary coordinates A, y A, z A).In like manner can obtain the pose matrix of survey station B place transit coordinate system in auxiliary coordinates
Figure 796363DEST_PATH_GSB00000550577500017
Can obtain the coordinate origin O of survey station B place transit thus BCoordinate (x in auxiliary coordinates B, y B, z B).
Step 2: respectively transit A, B are aimed at i measured point C i, record two groups of angle value (θ respectively Ai, α Ai) and (θ Bi, α Bi).The true origin O of transit A AWith C iForm a straight line O AC i, and the true origin O of transit B BWith C iForm a straight line O BC i, at auxiliary coordinates cathetus O AC iAnd O BC iThe straight-line equation expression formula be respectively:
O A C i : x Ci - x A cos θ Ai = y Ci - y A sin θ Ai = z Ci - z A cos α Ai ; O B C i : x Ci - x B cos θ Bi = y Ci - y B sin θ Bi = z Ci - z B cos α Bi
Make m 1=cos θ Ai, n 1=sin θ Ai, p 1=cos α Aim 2=cos θ Bi, n 2=sin θ Bi, p 2=cos α BiBecause two straight lines intersect at a same point C in the space i, therefore can get C iCoordinate in auxiliary coordinates does;
x Ci = m 1 m 2 ( y B - y A ) + m 2 n 1 x A - m 1 n 2 x B m 2 n 1 - m 1 n 2 , y ci = n 1 n 2 ( x A - x B ) - m 2 n 1 y B + m 1 n 2 y A m 2 n 1 - m 1 n 2
z Ci = z A + p 1 n 2 ( x A - x B ) - p 1 m 2 ( y B - y A ) m 2 n 1 - m 1 n 2
Step 3:, then aim at another D on this object again with transit if will measure the height and the attitude of an object (like tree, electric pole etc.) i, repeating step one and step 2 obtain D iCoordinate (x Di, y Di, z Di), thereby can obtain C iD iBetween distance (being the tree or the height of electric pole):
L = ( x Di - x Ci ) 2 + ( y Di - y Ci ) 2 + ( z Di - z Ci ) 2
Simultaneously can confirm line segment C iD iAttitude in auxiliary coordinates, as setting or electric pole inclination angle with respect to the horizontal plane:
Figure BSA00000379997800055
(3) the third embodiment: two transits are confirmed object position or attitude
Whether the method that the present invention proposes does not do requirement for transit leveling, centering.When adopting two transits to measure; If only measure the position of object; In the measurement two transits are aimed at the mark respectively and a little get final product; If also require to measure the attitude of testee, then need utilize transit to obtain on the measured target thing 2 angle information, confirm that the mathematical model that every bit adopts is just the same.Except that adopting two transits, identical described in implementation step and mathematical model and (two), repeat no more at this.

Claims (8)

1. an electronic theodolite is confirmed the test macro and the method for application thereof of object position and attitude.This system comprises: electronic theodolite, auxiliary coordinate device and data processing algorithm; Wherein electronic theodolite is used for confirming test target object angle degree; Auxiliary coordinate device is as the reference frame of transit; Institute's angle measurement degree information is passed to computing machine through data line, is resolved automatically by the data processing algorithm in the computing machine.It is characterized in that; Electronic theodolite need not leveling in the test process; Auxiliary coordinate device forms x axle and the y axle level and the z axle is vertical all the time all the time in the coordinate system, can realize utilizing single transit to carry out definite fast to position, the pose that can reach with unreachable object.
2. electronic theodolite according to claim 1 is confirmed the test macro of object position and attitude; It is characterized in that utilizing an auxiliary coordinate device that is independent of transit to confirm position and the attitude relation of transit coordinate system in auxiliary coordinates; Measure horizontal angle and the vertical angle of object/impact point in the transit coordinate system through transit, thereby realize the position of object and confirming of attitude.
3. the test macro that utilizes electronic theodolite to confirm object position and attitude according to claim 2; It is characterized in that not flatten transit in the measurement process; Need not to measure the distance of transit between putting to object/impact point and auxiliary coordinates bulk cargo, need not to measure in the same transit of different survey stations or the distance between the different transit.
4. electronic theodolite according to claim 1 is confirmed the test macro of object position and attitude, structure that wherein should auxiliary coordinate device including, but not limited to:
A support frame 1, this framework can directly be positioned on the ground, also can link to each other like tripod with other device;
A transverse axis 2, this rotating shaft terminal are fixed on the framework 1;
One first web member 10 is equipped with bearing between this web member 10 and the axle 2, and web member 10 can freely rotate around transverse axis 2 under action of gravity;
A transverse axis 11, it passes two coaxial apertures on the web member 10, and connects firmly with web member 10; One second web member 3, these web member 3 sides have a hole that supplies transverse axis 11 to pass, and its underpart has a screw, between web member 3 and the transverse axis 11 bearing is installed, and web member 3 can freely rotate around transverse axis 11;
A vertical axes 4, external thread has been attacked at the two ends of this vertical axes 4, and the threaded portion on these vertical axes 4 tops is threaded with screw in web member 3 bottoms;
One three shaft coupling piece 12; This three shaft coupling piece 12 has six smooth flat, and wherein two surfaces are surface level up and down, and all the other four sides are the vertical plane; Each surperficial central authorities is processed with screw, and its upper surface screw supplies the threaded portion of vertical axes 4 bottoms to screw in;
Top 5-9, external thread has been attacked in 5 top ends, with three shaft coupling pieces, 12 thread connection; These are top to can be used for finely tuning and makes the upper and lower surface of three shaft coupling pieces be in horizontality all the time; The axes intersect of these top 5-9 is in a bit simultaneously, and the cusp B-E on the top 5-8 forms a plane, and upward the formed plane of cusp B-E is vertical with top 5-8 for top 9 axis; These top effects are and can make the upper and lower surfaces of three shaft coupling pieces 12 be in horizontality for finely tuning.
5. electronic theodolite according to claim 1 is confirmed the test macro and the method for application thereof of object position and attitude, and the single transit that it is characterized by after the leveling capable of using is confirmed to reach object position or attitude, and its concrete measurement step is:
At first, place one at the object place and have known " ⊥ " shape scale of mutual alignment relation between 3 and 3 on it;
Secondly, the leveling transit then with 3 points on the transit difference alignment scale, is put pairing level with each and is measured with vertical angle, and these angle informations are passed in the computer with data line;
At last, utilize mathematical model
Figure FSA00000379997700021
to calculate the coordinate of measured target point in the transit coordinate system.
6. electronic theodolite according to claim 1 is confirmed the test macro and the method for application thereof of object position and attitude, it is characterized by the single transit without leveling capable of using and confirms to reach object position or attitude,, its concrete measurement step is:
At first, auxiliary coordinates system is positioned over makes things convenient for transit to observe part, aim at three reference point O on it respectively with transit r, A r, B r, record three groups of horizontal angles and vertical angle, each is put pairing level be passed in the computer with data line with vertical angle information.Adopt claim 5, wherein the step of determining the mathematical model with auxiliary coordinate system theodolite coordinate system position and attitude matrix
Figure FSA00000379997700022
to obtain theodolite coordinate system in the auxiliary coordinate system position and attitude matrix
Figure FSA00000379997700023
Secondly; By said identical step of claim 5 and method i measured target thing measured, confirm position and attitude relation
Figure FSA00000379997700024
between measured target thing place coordinate system and the transit coordinate system
At last, confirm position and the attitude that position and the attitude
Figure FSA00000379997700025
of measured target thing in auxiliary coordinates confirmed object.
7. electronic theodolite according to claim 1 is confirmed the test macro and the method for application thereof of object position and attitude; It is characterized by no matter whether transit flattens; Single transit all capable of using is confirmed the position or the attitude of unreachable object, and its concrete measurement step is:
At first, the auxiliary coordinates bulk cargo placed make things convenient for transit to observe part, then transit is positioned over survey station A place, transit is aimed at three the reference point Os of auxiliary coordinates bulk cargo in putting r, A r, B r, utilize the mathematical model described in the claim 5 to obtain the pose matrix of survey station A place transit coordinate system in auxiliary coordinates
Figure FSA00000379997700026
Can obtain the transit coordinate origin O of survey station A place thus ACoordinate (x in auxiliary coordinates A, y A, z A), transit is aimed at i measured point C i, C iPosition (the x of point in auxiliary coordinates Ci, y Ci, z Ci) the unknown, obtain angle value (θ Ai, α Ai), obtain straight line O AC iStraight-line equation expression formula in auxiliary coordinates:
Figure FSA00000379997700027
Secondly, then transit is positioned over survey station B place, transit is aimed at three reference point O of auxiliary coordinates bulk cargo in putting r, A r, B r, utilize the mathematical model described in the claim to obtain the pose matrix of survey station B place transit coordinate system in auxiliary coordinates
Figure FSA00000379997700028
Can obtain the transit coordinate origin O of survey station B place thus BCoordinate (x in auxiliary coordinates B, y B, z B), transit is aimed at i measured point C i, obtain angle value (θ Bi, α Bi), obtain straight line O BC iStraight-line equation expression formula in auxiliary coordinates:
At last, utilize two straight line O AC iWith O BC iIn the space, intersect at same point C i, its coordinate in auxiliary coordinates does;
( x Ci = m 2 ( y B - y A ) + m 2 n 1 x A - m 1 n 2 x B m 2 n 1 - m 1 n 2 , y Ci = n 1 n 2 ( x A - x B ) - m 2 n 1 y B + m 1 n 2 y A m 2 n 1 - m 1 n 2 , z Ci = z A + p 1 n 2 ( x A - x B ) - p 1 m 2 ( y B - y A ) m 2 n 1 - m 1 n 2 )
8. test macro and the method for application thereof of utilizing electronic theodolite to confirm object position and attitude according to claim 1; It is characterized by no matter whether transit flattens; Pair transit all capable of using is confirmed to reach or the position or the attitude of unreachable object; Wherein except that the same transit with A described in the claim 7, B two survey station places became two these points of transit instead, its concrete measurement step was identical with measurement step and the mathematical model described in the claim 7 fully with mathematical model.
CN2010105813039A 2010-12-10 2010-12-10 System and method for testing position and posture of target by using electronic theodolite Pending CN102538726A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN2010105813039A CN102538726A (en) 2010-12-10 2010-12-10 System and method for testing position and posture of target by using electronic theodolite

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN2010105813039A CN102538726A (en) 2010-12-10 2010-12-10 System and method for testing position and posture of target by using electronic theodolite

Publications (1)

Publication Number Publication Date
CN102538726A true CN102538726A (en) 2012-07-04

Family

ID=46346227

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2010105813039A Pending CN102538726A (en) 2010-12-10 2010-12-10 System and method for testing position and posture of target by using electronic theodolite

Country Status (1)

Country Link
CN (1) CN102538726A (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104266649A (en) * 2014-10-16 2015-01-07 北京卫星环境工程研究所 Method for measuring posture angle of base cubic mirror based on gyro theodolite
CN104613981A (en) * 2014-12-17 2015-05-13 中国人民解放军63863部队 Inertial-navigation dynamic directional precision testing system
CN105290701A (en) * 2014-06-06 2016-02-03 上海卫星装备研究所 High-pointing-accuracy plane finishing method based on integration of measurement and machining
CN107101578A (en) * 2017-04-26 2017-08-29 长沙迪迈数码科技股份有限公司 A kind of underground measuring point coordinate measuring method
CN108088412A (en) * 2016-11-23 2018-05-29 北京地林远景信息技术有限公司 A kind of method at total powerstation automatic And Rapid Determination agricultural rocket gun azimuth inclination angle
CN108871649A (en) * 2018-08-14 2018-11-23 坤维(北京)科技有限公司 A method of establishing the frame of reference
CN109813222A (en) * 2019-03-10 2019-05-28 河南省水利勘测有限公司 Well room measurement of coordinates auxiliary device and measurement method

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10221074A (en) * 1997-01-31 1998-08-21 Nippon Steel Corp Three-dimensional-coordinate measuring method
CN1603742A (en) * 2004-11-10 2005-04-06 北京林业大学 Electronic theodolite measurement system and tree survey method therefor
US20090082992A1 (en) * 2007-09-24 2009-03-26 Leica Geosystems Ag Method for determining positions of points to be measured
CN101655344A (en) * 2008-08-18 2010-02-24 北京航天计量测试技术研究所 Method for calibrating spatial coordinate measuring system of electronic theodolite
CN101726288A (en) * 2009-12-23 2010-06-09 王鹏飞 Quick and accurate self-leveling level

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10221074A (en) * 1997-01-31 1998-08-21 Nippon Steel Corp Three-dimensional-coordinate measuring method
CN1603742A (en) * 2004-11-10 2005-04-06 北京林业大学 Electronic theodolite measurement system and tree survey method therefor
US20090082992A1 (en) * 2007-09-24 2009-03-26 Leica Geosystems Ag Method for determining positions of points to be measured
CN101655344A (en) * 2008-08-18 2010-02-24 北京航天计量测试技术研究所 Method for calibrating spatial coordinate measuring system of electronic theodolite
CN101726288A (en) * 2009-12-23 2010-06-09 王鹏飞 Quick and accurate self-leveling level

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
孙汉旭等: "一种基于电子经纬仪的机械臂运动精度测试新方法研究", 《仪器仪表学报》, vol. 28, no. 12, 31 December 2007 (2007-12-31) *
谭月胜等: "空间机械臂的一种自标定方法", 《宇航学报》, vol. 27, no. 3, 31 May 2006 (2006-05-31) *

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105290701A (en) * 2014-06-06 2016-02-03 上海卫星装备研究所 High-pointing-accuracy plane finishing method based on integration of measurement and machining
CN104266649A (en) * 2014-10-16 2015-01-07 北京卫星环境工程研究所 Method for measuring posture angle of base cubic mirror based on gyro theodolite
CN104266649B (en) * 2014-10-16 2017-09-15 北京卫星环境工程研究所 Method based on gyrotheodolite measuring basis prism square attitude angle
CN104613981A (en) * 2014-12-17 2015-05-13 中国人民解放军63863部队 Inertial-navigation dynamic directional precision testing system
CN108088412A (en) * 2016-11-23 2018-05-29 北京地林远景信息技术有限公司 A kind of method at total powerstation automatic And Rapid Determination agricultural rocket gun azimuth inclination angle
CN107101578A (en) * 2017-04-26 2017-08-29 长沙迪迈数码科技股份有限公司 A kind of underground measuring point coordinate measuring method
CN107101578B (en) * 2017-04-26 2019-07-02 长沙迪迈数码科技股份有限公司 A kind of underground measuring point coordinate measurement method
CN108871649A (en) * 2018-08-14 2018-11-23 坤维(北京)科技有限公司 A method of establishing the frame of reference
CN108871649B (en) * 2018-08-14 2020-07-14 坤维(北京)科技有限公司 Method for establishing reference coordinate system
CN109813222A (en) * 2019-03-10 2019-05-28 河南省水利勘测有限公司 Well room measurement of coordinates auxiliary device and measurement method
CN109813222B (en) * 2019-03-10 2020-07-14 河南省水利勘测有限公司 Measurement method based on well room coordinate measurement auxiliary device

Similar Documents

Publication Publication Date Title
CN102538726A (en) System and method for testing position and posture of target by using electronic theodolite
CN103454619B (en) Electrical axis optical calibration system of spaceborne microwave tracking-pointing radar and calibration method thereof
CN101387501B (en) Ultra-large workpiece circular section shape and azimuthal measurement apparatus and method
CN103292748B (en) A kind of split of many substrates based on laser measurement detection method
CN105651166B (en) Spacecraft product final assemble accuracy measurement method based on workpiece coordinate system
CN107167790A (en) A kind of step scaling method of laser radar two based on Calibration Field
CN109782225B (en) Method for positioning coordinates of base station
CN103499293B (en) Virtual multi-station type measurement method of laser tracker of numerically-controlled machine tool
CN101413785B (en) Error compensation method of positioning system based on double-rotating laser plane transmitter network
CN104457688B (en) High-precision automatic measurement device for batch equipment attitude angle matrix on satellite
Xiong et al. Workspace measuring and positioning system based on rotating laser planes
CN103737433B (en) Large-size components combined type accuracy measurement method
CN103954245A (en) Precision calibration plate for articulated coordinate measuring machine
CN102607516B (en) Method for measuring standard elevation in nuclear power engineering
CN102621559B (en) Portable global position system (GPS)-real time kinematic (RTK) rapid auxiliary wall corner point measuring device and measuring method
CN104748695B (en) Based on large-section underground cavern's early deformation monitoring method that section is finely measured
CN110440743A (en) A kind of tunnel deformation monitoring method, system, medium and equipment based on baseline
CN109579759A (en) A kind of method of secondary coordinate fitting mensuration detection high-precision overlength standard component
CN203824548U (en) Bridge structure concrete surface observation area measuring instrument
CN111947606B (en) Tunnel central axis auxiliary measuring device and measuring method thereof
CN104613981A (en) Inertial-navigation dynamic directional precision testing system
JP2018179533A (en) Inclination measurement device, measurement method of accuracy of steel column election using same, calibration method of inclination measurement device, and inclination measurement processing program
JP7368571B1 (en) Location accuracy evaluation method
CN113513986B (en) Geometric tolerance measuring device and measuring method thereof
CN206493337U (en) A kind of test device of industrial robot repetitive positioning accuracy

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C02 Deemed withdrawal of patent application after publication (patent law 2001)
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20120704