POSITIONING METHOD OF FUNCTIONAL ROTATION CENTER OF SHOULDER BASED ON RIGID UPPER ARM MODEL

20220378329 · 2022-12-01

Assignee

Inventors

Cpc classification

International classification

Abstract

A positioning method of functional rotation center of shoulder based on rigid upper arm model includes: step 1: abstracting a human upper arm into a cylinder with FRCS as a center of top surface; step 2: determining a reference axis vector of the cylinder; step 3: determining an axis vector of the cylinder and a displacement from the reference axis vector to the axis vector; step 4: correcting a central axis direction of the cylinder; step 5: determining a height compensation of the cylinder, and positioning the FRCS. The method has higher accuracy for the positioning result of FRCS, the positioning result of FRCS has better stability relative to the upper arm and trunk, and can be used to establish a more accurate human digital dynamic model and predict more accurate human posture.

Claims

1. A positioning method of a functional rotation center of a shoulder (FRCS) based on a rigid upper arm model, comprising: step 1: abstracting a human upper arm into a cylinder with the FRCS as a center of a top surface; step 2: determining a reference axis vector of the cylinder; step 3: determining an axis vector of the cylinder and a displacement from the reference axis vector to the axis vector, wherein, the reference axis vector is translated {right arrow over (D.sup.pm)} in a direction perpendicular to a reference direction of the cylinder, to obtain the axis vector, and a distance from the axis vector to each point on a skin surface of the human upper arm is equal; step 4: correcting the reference axis vector of the cylinder; step 5: determining a height compensation of the cylinder, and positioning the FRCS.

2. The positioning method of the FRCS based on the rigid upper arm model according to claim 1, wherein, in the step 2, the reference axis vector is a vector {right arrow over (A.sup.rm)} which starts from a midpoint (represented by mark MD) of medial and lateral epicondylar points of a humerus on a human surface to an acromion point (represented by mark MU), and a direction of the vector {right arrow over (A.sup.rm)} is the reference direction of the cylinder; {right arrow over (A.sup.rm)}M.sup.U−M.sup.D, wherein M.sup.U=[X.sup.U Y.sup.U Z.sup.U].sup.T represents position information of the acromion point MU, M.sup.D=[X.sup.D Y.sup.D Z.sup.D].sup.T represents position information of the midpoint MD of the medial and lateral epicondylar points of the humerus; for any point A on a skin surface of the human upper arm, position information of the point A from starting time t.sub.0 to ending time t.sub.S is expressed as M.sup.A, M A = [ X A Y A Z A ] T = [ X t 0 A X t 0 + Δ t A X t 0 + 2 Δ t A .Math. X t s A Y t 0 A Y t 0 + Δ t A Y t 0 + 2 Δ t A .Math. Y t s A Z t 0 A Z t 0 + Δ t A Z t 0 + 2 Δ t A .Math. Z t s A ] , wherein t.sub.S=t.sub.0+kΔt, k≥3, Δt is a sampling interval.

3. (canceled)

4. The positioning method of the FRCS based on the rigid upper arm model according to claim 1, wherein, in the step 3, an end point of the axis vector is a vertex of the cylinder, that is, the FRCS, and position information of the FRCS is expressed as:
RCS.sup.F=M.sup.U+{right arrow over (D.sup.pm)}  {circle around (1)}.

5. The positioning method of the FRCS based on the rigid upper arm model according to claim 4, wherein, the step 3 comprises: step 31: determining three marking points M1, M2 and M3 on the skin surface of the human upper arm, and vertical vectors {right arrow over (R.sup.1)}, {right arrow over (R.sup.2)}, and {right arrow over (R.sup.3)} respectively from the marking points M1, M2 and M3 to the reference axis vector being translated to make a start point of each of the vertical vectors be located at the midpoint MD of the medial and lateral epicondylar points of the humerus at that time; step 32: determining a center of a circle where an end point of each of the vertical vectors is located after a translation (represented by mark O), a displacement from the midpoint MD of the medial and lateral epicondyle points of the humerus to the center O being {right arrow over (D.sup.mp)} denoting a displacement from the reference axis vector to the axis vector.

6. The positioning method of the FRCS based on the rigid upper arm model according to claim 4, wherein, in the step 3, for any time t.sub.a in a process, a coordinate system is translated to establish a local coordinate system, wherein the local coordinate takes M.sub.t.sub.a.sup.D=[X.sub.t.sub.a.sup.D Y.sub.t.sub.a.sup.D Z.sub.t.sub.a.sup.D].sup.T as a coordinate origin, then, at the time t.sub.a, reverse vectors {right arrow over (R.sub.t.sub.a.sup.n)} of vertical vectors respectively from marking points M1, M2 and M3 to the reference axis vector satisfy a relational formula {right arrow over (R.sub.t.sub.a.sup.n)}=R.sub.t.sub.a.sup.n−0, wherein, R.sub.t.sub.a.sup.n represent end coordinates of the vectors {right arrow over (R.sub.t.sub.a.sup.n)}, n=1, 2, 3.

7. The positioning method of the FRCS based on the rigid upper arm model according to claim 6, wherein, according to formula .Math. "\[LeftBracketingBar]" O xt a O yt a O zt a 1 R xt a 1 R yt a 1 R zt a 1 1 R xt a 2 R yt a 2 R zt a 2 1 R xt a 3 R yt a 3 R zt a 3 1 .Math. "\[RightBracketingBar]" = 0 and formula ( R x t a 1 - O x t a ) 2 + ( R y t a 1 - O y t a ) 2 + ( R z t a 1 - O z t a ) 2 = ( R x t a 2 - O x t a ) 2 + ( R y t a 2 - O y t a ) 2 + ( R z t a 2 - O z t a ) 2 = ( R x t a 3 - O x t a ) 2 + ( R y t a 3 - O y t a ) 2 + ( R z t a 3 - O z t a ) 2 , determining coordinates O.sub.t.sub.a=[O.sub.xt.sub.a O.sub.yt.sub.a O.sub.zt.sub.a].sup.T of the center O at the time t.sub.a, restoring the coordinates O.sub.t.sub.a=[O.sub.xtO.sub.yt.sub.a O.sub.zt.sub.a].sup.T to a global coordinate system, wherein the vector {right arrow over (A.sup.rm)} is translated to make a starting point of the vector A.sup.rm coincide with the O.sub.t.sub.a to obtain a translation {right arrow over (D.sup.pm)}, at this time, an end point of the vector {right arrow over (A.sup.rm)} after the translation is the a position of the FRCS.

8. The positioning method of the FRCS based on the rigid upper arm model according to claim 7, wherein, in the step 4, a central axis of the cylinder is corrected by introducing a proportion coefficient n of a height of the marking points on the skin surface of the human upper arm in the cylinder to a total height of the cylinder.

9. The positioning method of the FRCS based on the rigid upper arm model according to claim 8, wherein, the step 4 comprises: step 41: projecting the three marking points M1, M2 and M3 on the skin surface of the human upper arm to the reference axis vector, for any time t.sub.a in the process, there being relational formulas { n t a fir A t a rm .Math. + R t a 1 .Math. = M t a 1 - M t a D n t a sec A t a rm .Math. + R t a 2 .Math. = M t a 2 - M t a D n t a thd A t a rm .Math. + R t a 1 .Math. = M t a 3 - M t a D and { A t a rm .Math. .Math. R t a 1 .Math. = 0 A t a rm .Math. .Math. R t a 2 .Math. = 0 A t a rm .Math. .Math. R t a 3 .Math. = 0 wherein {right arrow over (R.sub.t.sub.a.sup.1)} represents a vector starting from a perpendicular foot from the marking point M1 to a vector {right arrow over (A.sub.t.sub.a.sup.rm)} and pointing to the marking point M1 at the time t.sub.a, meanings of {right arrow over (R.sub.t.sub.a.sup.2)} and {right arrow over (R.sub.t.sub.a.sup.3)} can be inferred from a meaning of {right arrow over (R.sub.t.sub.a.sup.1)}; n.sub.t.sub.a.sup.fir, n.sub.t.sub.a.sup.sec and n.sub.t.sub.a.sup.thd respectively represent ratios of vectors starting from MD and pointing to perpendicular feet from the marking points M1, M2 and M3 to the vector {right arrow over (A.sub.t.sub.a.sup.rm)} at the time t.sub.a; M.sub.t.sub.a.sup.1 represents position coordinates of the marking point M1 at the time t.sub.a, meanings of M.sub.t.sub.a.sup.2, M.sub.t.sub.a.sup.3, M.sub.t.sub.a.sup.D, M.sub.t.sub.a.sup.U can be inferred from a meaning of M.sub.t.sub.a.sup.1; step 42: marking n.sup.fir=[n.sub.t.sub.0.sup.fir n.sub.t.sub.0.sub.+Δt.sup.fir n.sub.t.sub.0.sub.+2Δt.sup.fir . . . n.sub.t.sub.S.sup.fir], n al = [ n fir n sec n thd ] , in combining formula {circle around (6)} with formula {circle around (7)}, and obtaining that at the time t.sub.a: n t a al = [ ( M t a 1 - M t a D ) T ( M t a 2 - M t a D ) T ( M t a 3 - M t a D ) T ] .Math. ( M t a U - M t a D ) .Math. ( ( M t a U - M t a D ) T .Math. ( M t a U - M t a D ) ) - 1 ; _ step 43: selecting a proportion coefficient n.sub.t.sub.j.sup.al at time t.sub.j when arms are vertically downward in a human standing posture as a standard coefficient, adding a correction amount {right arrow over (A.sub.t.sub.a.sup.cps)} to the {right arrow over (A.sub.t.sub.a.sup.rm)} at the any time t.sub.a to make the proportion coefficient n.sub.t.sub.a.sup.al close to n.sub.t.sub.j.sup.al, that is to make: n al = [ n t j fir .Math. [ 1 1 .Math. 1 ] n t j sec .Math. [ 1 1 .Math. 1 ] n t j thd .Math. [ 1 1 .Math. 1 ] ] and n.sup.al′ and {right arrow over (A.sub.t.sub.a.sup.rm′)} after corrected meet requirements of formulas {circle around (4)} and {circle around (5)}; step 44: according to the correction amount {right arrow over (A.sub.ta.sup.cps)} without changing modulus |{right arrow over (A.sub.t.sub.a.sup.rm)}| of the axis vector, obtaining:
|{right arrow over (A.sub.t.sub.a.sup.rm′)}|=|{right arrow over (A.sub.t.sub.a.sup.rm)}+{right arrow over (A.sub.t.sub.a.sup.cps)}|=|{right arrow over (A.sub.t.sub.a.sup.rm)}|  {circle around (8)}; step 45: in a conical generatrix set satisfying a first column of formula {circle around (6)}, a first column of formula {circle around (7)}, and formula {circle around (8)}, a conical generatrix set satisfying a second column of formula {circle around (6)}, a second column of formula {circle around (7)}, and formula {circle around (8)}, and a conical generatrix set satisfying a third column of formula {circle around (6)}, a third column of formula {circle around (7)}, and formula {circle around (8)}, respectively selecting solutions closest to {right arrow over (A.sub.t.sub.a.sup.rm)} and combining the solutions to obtain {right arrow over (A.sub.t.sub.a.sup.rm′)}, and then obtaining a final correction {right arrow over (A.sub.ta.sup.cps)}, according to the final correction {right arrow over (A.sub.ta.sup.cps)}, rewriting formula {circle around (1)} as:
RCS.sup.F=M.sup.U+{right arrow over (A.sup.cps)}+{right arrow over (D.sup.pm)}  {circle around (13)} wherein {right arrow over (D.sup.pm)} is resolved according to an axis vector {right arrow over (A.sup.rm′)} in a correction direction.

10. The positioning method of the FRCS based on the rigid upper arm model according to claim 9, wherein, in the step 5, after determining the height compensation of the cylinder, a final calculation formula of the FRCS is:
RCS.sup.F=M.sup.U+{right arrow over (A.sup.cps)}+{right arrow over (D.sup.pm)}−(1−l.sup.rm)({right arrow over (A.sup.rm)}+{right arrow over (A.sup.cps)})  {circle around (17)} wherein, the l.sup.rm is a height compensation coefficient of the cylinder.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0024] FIG. 1 is a flowchart of a preferred embodiment of a positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0025] FIG. 2 is a schematic diagram of a reference axis vector and an axis vector of the embodiment shown in FIG. 1 of positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0026] FIG. 3 is a schematic diagram of three marking points of the embodiment shown in FIG. 1 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0027] FIG. 4-FIG. 6 are schematic diagrams of correction of a central axis of the embodiment shown in FIG. 1 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0028] FIG. 7 is a schematic diagram of a positioning process of the embodiment shown in FIG. 1 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0029] FIG. 8 is a schematic diagram of an experimental environment of another embodiment of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0030] FIG. 9 is a schematic diagram of pasting positions of the marking points on the human upper arm during an experiment of the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0031] FIG. 10 is a data acquisition result of marking points of a subject in the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0032] FIG. 11 is a motion trajectory of a right upper arm of a subject in the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0033] FIG. 12 is a schematic diagram of a relative position in trunk of the FRCS positioning result of subject No. 1 in the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0034] FIG. 13 shows coefficients n1, n2 and n3 of three marking points M1, M2 and M3 on the upper arm to a corrected axis vector for the subject No. 1 in the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0035] FIG. 14 shows variation trend of the coefficients n1, n2 and n3 of the three marking points M1, M2 and M3 on the upper arm to the axis vectors before and after correction during test time for the subject No. 1 in the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0036] FIG. 15 is a schematic diagram of translation correction of a central axis position of the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0037] FIG. 16 shows before compensation, variations of distance from the FRCS positioning result to the three marking points M1, M2 and M3 on the upper arm for the subject No. 1 in the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0038] FIG. 17 shows after compensation, variations of distance from the FRCS positioning result to the three marking points M1, M2 and M3 on the upper arm for the subject No. 1 in the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

[0039] FIG. 18 shows standard deviation of variations of distance from the FRCS positioning result to the three marking points on the upper arm for right shoulders of 28 subjects in the embodiment shown in FIG. 8 of the positioning method of functional rotation center of shoulder based on rigid upper arm model according to the present invention.

DETAILED DESCRIPTION OF THE EMBODIMENTS

[0040] For better understanding of the present invention, detailed description of the invention is provided below with reference to specific embodiments.

Embodiment 1

[0041] As shown in FIG. 1, a positioning method of functional rotation center of shoulder based on rigid upper arm model comprises:

step 1: abstracting a human upper arm into a cylinder with FRCS as a center of top surface;
step 2: determining a reference axis vector of the cylinder;
step 3: determining an axis vector of the cylinder and a displacement from the reference axis vector to the axis vector;
step 4: correcting a central axis direction of the cylinder;
step 5: determining a height compensation of the cylinder, and positioning the FRCS.

[0042] For the step 1: abstracting a human upper arm into a cylinder with FRCS as a center of top surface, in this embodiment:

when human trunk is fixed, a main way of movement of the upper arm is rotation. In a very short time, motion amplitude of an end of a humerus is much greater than that of a top of the humerus, if a deformation of the upper arm in the movement is ignored, the upper arm rotates approximately around the FRCS in the movement. In geometric operations, if spatial position changes of at least three points on surface of the upper arm can be obtained, a position of the FRCS can be determined. Therefore, in the step 1, the human upper arm is abstracted into a cylinder with FRCS as a center of top surface, and accordingly, the skin surface of the human upper arm is abstracted as side surface of the cylinder.

[0043] For the step 2: determining a reference axis vector of the cylinder, in this embodiment:

as shown in FIG. 2, in the step 2, the reference axis vector is a vector {right arrow over (A.sup.rm)} which starts from a midpoint (represented by mark MD) of medial and lateral epicondylar points of the humerus on human surface and points to an acromion point (represented by mark MU), and its direction is a reference direction of the cylinder, mark {right arrow over (A.sup.rm)}=M.sup.U−M.sup.D, wherein M.sup.D=[X.sup.U Y.sup.U Z.sup.U].sup.T represents position information of the acromion point MU, M.sup.D=[X.sup.D Y.sup.D Z.sup.D].sup.T represents position information of the midpoint MD of the medial and lateral epicondylar points of the humerus.

[0044] In motion measurement, a measurement process will last for a period, for convenience of description, starting time of the measurement process is denoted by t.sub.0, and ending time thereof is denoted by t.sub.S, during the period, positions of selected marking points on human surface are continuously collected to obtain position information of the marking points on the human surface within the period. For any point A on the skin surface of the human upper arm, position information of the point A from starting time t.sub.0 to ending time t.sub.S is expressed as M.sup.A,

[00008] M A = [ X A Y A Z A ] T = [ X t 0 A X t 0 + Δ t A X t 0 + 2 Δ t A .Math. X t s A Y t 0 A Y t 0 + Δ t A Y t 0 + 2 Δ t A .Math. Y t s A Z t 0 A Z t 0 + Δ t A Z t 0 + 2 Δ t A .Math. Z t s A ] ,

wherein t.sub.S=t.sub.0+kΔt, k≥3, Δt is sampling interval. In this embodiment, considering convenience of calculation, limitation of experimental conditions, and accuracy and repeatability of calculation results, it is set that k=500, Δt=0.01 ms.

[0045] For the step 3: determining an axis vector of the cylinder and a displacement from the reference axis vector to the axis vector, in this embodiment:

as shown in FIG. 2, in the step 3, the reference axis vector {right arrow over (A.sup.rm)} is translated {right arrow over (D.sup.pm)} in a direction perpendicular to the reference direction to obtain the axis vector, and distance from the axis vector to each point on the skin surface of the upper arm is equal. An end point of the axis vector is a vertex of the cylinder, that is, FRCS, and position information of the FRCS is expressed as:


RCS.sup.F=M.sup.U+{right arrow over (D.sup.pm)}  ({circle around (1)}).

[0046] Because the axis vector is obtained by translating the reference axis vector in the direction perpendicular to the reference direction, and the distance from the axis vector to the marking points on the upper arm is equal, therefore, if three mark points are selected on skin surface of the upper arm, according to properties in spatial geometry that a section of the cylinder is circular, in the section of the cylinder, a center of a circle formed by projection points which are obtained by projecting the three marking points on the upper arm to the section along the reference direction is an intersection of the axis vector and the mentioned section. Based on the above theory, in the step 3, a specific process of determining the displacement {right arrow over (D.sup.pm)} from the reference axis vector to the axis vector comprises:

step 31: as shown in FIG. 3, determining three marking points M1, M2 and M3 on the skin surface of the human upper arm, and vertical vectors {right arrow over (R.sup.1)}, {right arrow over (R.sup.2)}, and {right arrow over (R.sup.3)} respectively from the marking points M1, M2 and M3 to the reference axis vector being translated to make a start point of each vertical vector be located at the midpoint MD of the medial and lateral epicondylar points of the humerus at that time;
step 32: determining a center of a circle where an end point of each vertical vector is located after translation (represented by mark O), a displacement from the midpoint MD of the medial and lateral epicondyle points of the humerus to the center O being a displacement from the reference axis vector to the axis vector, namely {right arrow over (D.sup.pm)}.

[0047] Specifically, for any time t.sub.a in the measurement process, translating a coordinate system to establish a local coordinate system which takes M.sub.t.sub.a.sup.D=[X.sub.t.sub.a.sup.D Y.sub.t.sub.a.sup.D Z.sub.t.sub.a.sup.D].sup.T as a coordinate origin, then, at the time t.sub.a, reverse vectors {right arrow over (E.sub.t.sub.a.sup.n)} of vertical vectors respectively from the marking points M1, M2 and M3 to the reference axis vector satisfy a relational formula {right arrow over (R.sub.t.sub.a.sup.n)}=R.sub.t.sub.a.sup.n−0, wherein, R.sub.t.sub.a.sup.n represent end coordinates of the vectors {right arrow over (R.sub.t.sub.a.sup.n)}, n=1, 2, 3. In a plane where three points represented by coordinates R.sub.t.sub.a.sup.1, R.sub.t.sub.a.sup.2 and R.sub.t.sub.a.sup.3 are located, find a center of a circle where the three points are located on: since the three points and the center of the circle where the three points are located on are in the same plane, then:

[00009] .Math. "\[LeftBracketingBar]" O xt a O yt a O zt a 1 R xt a 1 R yt a 1 R zt a 1 1 R xt a 2 R yt a 2 R zt a 2 1 R xt a 3 R yt a 3 R zt a 3 1 .Math. "\[RightBracketingBar]" = 0 ,

at the same time, because the distances from the three points to the center of the circle where the three points are located on are equal, then:

[00010] ( R xt a 1 - O xt a ) 2 + ( R yt a 1 - O yt a ) 2 + ( R zt a 1 - O zt a ) 2 = ( R xt a 2 - O xt a ) 2 + ( R yt a 2 - O yt a ) 2 + ( R zt a 2 - O zt a ) 2 = ( R xt a 3 - O xt a ) 2 + ( R yt a 3 - O yt a ) 2 + ( R zt a 3 - O zt a ) 2 ,

combining formula {circle around (4)} with formula {circle around (5)}, coordinates O.sub.t.sub.a=[O.sub.xt.sub.a O.sub.yt.sub.a O.sub.zt.sub.a].sup.T of center O at the time t.sub.a can be determined, and then restore them to a global coordinate system, that is, translate the vector {right arrow over (A.sup.rm)} to make a starting point of the vector{right arrow over (A.sup.rm)} coincide with the O.sub.t.sub.a to obtain a translation {right arrow over (D.sup.pm)}, at this time, an end point of the vector {right arrow over (A.sup.rm)} after translation is the position of the FRCS

[0048] For the step 4: correcting a central axis direction of the cylinder, in this embodiment: the reference axis vector {right arrow over (A.sup.rm)} is determined according to a bony landmarks point, geometrically, it deviates from the central axis of the cylinder (the line where the axis vector is located), in order to make the calculation results more accurate, a direction of the central axis of the cylinder needs to be corrected.

[0049] A rigid cylinder does not be deformed in translation and rotation, so a relative position of points on its surface in the cylinder is unchanged, and then a cutting ratio of an intersection of a cross section where the points on its surface are located and the central axis to a central axis segment is unchanged. The central axis of the cylinder is corrected by introducing a proportion coefficient n of a height of marking point on the surface of the upper arm in the cylinder to a total height of the cylinder.

[0050] As shown in FIG. 4, the step 4 comprises:

step 41: projecting the three marking points M1, M2 and M3 on the surface of the upper arm to the reference axis vector, for any time t.sub.a in the process, there being relational formulas

[00011] { n t a fir A t a rm .Math. + R t a 1 .Math. = M t a 1 - M t a D n t a sec A t a rm .Math. + R t a 2 .Math. = M t a 2 - M t a D n t a thd A t a rm .Math. + R t a 1 .Math. = M t a 3 - M t a D and { A t a rm .Math. .Math. R t a 1 .Math. = 0 A t a rm .Math. .Math. R t a 2 .Math. = 0 A t a rm .Math. .Math. R t a 3 .Math. = 0

wherein {right arrow over (R.sub.t.sub.a.sup.1)} represents a vector starting from a perpendicular foot from the marking point M1 to the vector {right arrow over (A.sub.t.sub.a.sup.rm)} and pointing to the marking point M1 at time t.sub.a, meanings of {right arrow over (R.sub.t.sub.a.sup.2)} and {right arrow over (R.sub.t.sub.a.sup.3)} can be inferred from this; n.sub.t.sub.a.sup.fir, n.sub.t.sub.a.sup.sec and n.sub.t.sub.a.sup.thd respectively represent ratios of vectors starting from MD and pointing to the perpendicular foot of the marking points M1, M2 and M3 to the vector {right arrow over (A.sub.t.sub.a.sup.rm)} at the time t.sub.a; M.sub.t.sub.a.sup.1 represents position coordinates of the marking point M1 at the time t.sub.a, meanings of M.sub.t.sub.a.sup.2, M.sub.t.sub.a.sup.3, M.sub.t.sub.a.sup.D, M.sub.t.sub.a.sup.U can be inferred from this.
step 42: marking n.sup.fir=[n.sub.t.sub.0.sup.fir n.sub.t.sub.0+Δt.sup.fir N.sub.t.sub.0.sub.+2Δt.sup.fir . . . n.sub.t.sub.S.sup.fir],

[00012] n al = [ n fir n sec n thd ] ,

combining formula {circle around (6)} with formula {circle around (7)}, and obtaining that at the time t.sub.a:

[00013] n t a al = [ ( M t a 1 - M t a D ) T ( M t a 2 - M t a D ) T ( M t a 3 - M t a D ) T ] .Math. ( M t a U - M t a D ) .Math. ( ( M t a U - M t a D ) T .Math. ( M t a U - M t a D ) ) - 1 .

step 43: the proportion coefficient n is used to describe a proportion of the height of the marking point in the cylinder to the total height of the cylinder, in the rigid cylinder, the coefficient n corresponding to the same marking point does not change during movement of the cylinder. However, since {right arrow over (A.sup.rm)} is not parallel to the actual central axis, during the whole test period (t.sub.S−t.sub.0), the coefficients n of the same marking point at different times are not all the same, so that, a proportion coefficient n.sub.t.sub.j.sup.al at time t.sub.j when the arms are vertically downward in a human standing posture being selected as a standard coefficient, adding a correction amount {right arrow over (A.sub.ta.sup.cps)} to the {right arrow over (A.sub.t.sub.a.sup.rm)} at any time t.sub.1 to make the proportion coefficient n.sub.t.sub.j.sup.al close to n.sub.t.sub.j.sup.al, that is to make:

[00014] n al = [ n t j fir .Math. [ 1 1 .Math. 1 ] n t j sec .Math. [ 1 1 .Math. 1 ] n t j thd .Math. [ 1 1 .Math. 1 ] ]

and n.sup.al′ and {right arrow over (A.sub.t.sub.a.sup.rm′)} after correction meet requirements of the formulas {circle around (4)} and {circle around (5)}.
step 44: according to the correction amount {right arrow over (A.sub.ta.sup.cps)} doesn't change modulus |{right arrow over (A.sub.t.sub.a.sup.rm)}| of the axis vector, obtaining:


|{right arrow over (A.sub.t.sub.a.sup.rm′)}|=|{right arrow over (A.sub.t.sub.a.sup.rm)}+{right arrow over (A.sub.t.sub.a.sup.cps)}|=|{right arrow over (A.sub.t.sub.a.sup.rm)}|  {circle around (8)}.

step 45: in a conical generatrix set satisfying the first column of formula {circle around (6)}, the first column of formula {circle around (7)} and formula {circle around (8)}, a conical generatrix set satisfying the second column of formula {circle around (6)}, the second column of formula {circle around (7)} and formula {circle around (8)}, and a conical generatrix set satisfying the third column of formula {circle around (6)}, the third column of formula {circle around (7)} and formula {circle around (8)}, respectively selecting solutions closest to {right arrow over (A.sub.t.sub.a.sup.rm)} and combining them to obtain {right arrow over (A.sub.t.sub.a.sup.rm′)}, and then obtaining a final correction {right arrow over (A.sub.ta.sup.cps)}, according to thefinal correction {right arrow over (A.sub.ta.sup.cps)}, rewriting the formula {circle around (1)} as:


RCS.sup.F=M.sup.U+{right arrow over (A.sup.cps)}+{right arrow over (D.sup.pm)}  {circle around (13)}

wherein {right arrow over (D.sub.pm)} is resolved according to the axis vector {right arrow over (A.sup.rm′)} in the correction direction.

[0051] The number of the correction amount {right arrow over (A.sub.ta.sup.cps)} satisfying the first column of formula {circle around (6)}, the first column of formula {circle around (7)} and formula {circle around (8)} is infinite, as shown in FIG. 5A, FIG. 5B, and FIG. 5C, a set of {right arrow over (A.sub.t.sub.a.sup.rm′)} satisfying the above condition is a conical generatrix set rotating around (M.sub.t.sub.a.sup.1−M.sub.t.sub.a.sup.D); similarly, a set of {right arrow over (A.sub.t.sub.a.sup.rm′)} satisfying the second column of formula {circle around (6)}, the second column of formula {circle around (7)} and formula {circle around (8)} is a conical generatrix set rotating around (M.sub.t.sub.a.sup.2−M.sub.t.sub.a.sup.D), a set of {right arrow over (A.sub.t.sub.a.sup.rm′)} satisfying the third column of formula {circle around (6)}, the third column of formula {circle around (7)} and formula {circle around (8)} is a conical generatrix set rotating around (M.sub.t.sub.a.sup.3−M.sub.t.sub.a.sup.D); therefore, as shown in FIG. 6, a simultaneous solution of the formula {circle around (6)}, formula {circle around (7)} and formula {circle around (8)} in space is a common generatrix of three cones with a same vertex. The vertices of the three cones are the same and are M.sub.t.sub.a.sup.D; the central axes of the three cones are (M.sub.t.sub.a.sup.1−M.sub.t.sub.a.sup.D), (M.sub.t.sub.a.sup.2−M.sub.t.sub.a.sup.D) and (M.sub.t.sub.a.sup.3−M.sub.t.sub.a.sup.D) respectively; length of the generatrix of the three cones is |{right arrow over (A.sub.t.sub.a.sup.rm)}|; perpendicular feet from the three marking points M1, M2 and M3 to their respective generatrices cut the generatrices according to the coefficient n.sup.al′. However, in practice, there is a situation that there is no a common generatrix of three cones, that is, there is no simultaneous solution of the formula {circle around (6)}, formula {circle around (7)} and formula {circle around (8)}. Therefore, in the three conical generatrix sets, solutions closest to {right arrow over (A.sub.t.sub.a.sup.rm)} are respectively selected and combined to obtain {right arrow over (A.sub.t.sub.a.sup.rm′)}, and then a final correction {right arrow over (A.sub.ta.sup.cps)} is obtained.

[0052] For the marking point M1, when vector M.sub.t.sub.a.sup.1−M.sub.t.sub.a.sup.D is coplanar with {right arrow over (A.sup.rm)} and its compensation result, there is a minimum |{right arrow over (A.sub.ta.sup.cps1)}|, setting the coefficient n.sub.c as a multiple of extending or shortening a perpendicular from the marking point to the axis to make the perpendicular intersect with the a compensated axis, then n.sub.c satisfies the formula:


n.sub.ct.sub.a.sup.fir[n.sub.t.sub.a.sup.fir.Math.{right arrow over (A.sub.t.sub.a.sup.rm)}−(M.sub.t.sub.a.sup.1−M.sub.t.sub.a.sup.D)]+(M.sub.t.sub.a.sup.1−M.sub.t.sub.a.sup.D)={right arrow over (M.sub.t.sub.a.sup.1its)}  {circle around (9)}

wherein, n.sub.ct.sub.a.sup.fir is n.sub.c of the marking point M1 on the upper arm at time t.sub.a, {right arrow over (M.sub.t.sub.a.sup.1its)} is a vector starting from M.sub.t.sub.a.sup.D and pointing to an intersection of the perpendicular from the marking point M1 to the axis and the compensated axis. {right arrow over (M.sub.t.sub.a.sup.1its)} is collinear with the compensated axis vector, and the modulus ratio between the vectors is:


{right arrow over (M.sub.t.sub.a.sup.1its)}.Math.|{right arrow over (A.sub.t.sub.a.sup.rm)}|/|{right arrow over (M.sub.t.sub.a.sup.1its)}|={right arrow over (A.sub.t.sub.a.sup.rm)}+{right arrow over (A.sub.t.sub.a.sup.cps1)}  {circle around (10)}.

Substitute the correction result {right arrow over (A.sub.t.sub.a.sup.rm′)}={right arrow over (A.sub.t.sub.a.sup.rm)}+{right arrow over (A.sub.t.sub.a.sup.cps1)} into the formula {circle around (6)}, formula {circle around (7)} and formula {circle around (8)}, then for the marking point M1 there is:


[(M.sub.t.sub.a.sup.1−M.sub.t.sub.a.sup.D)−n.sub.t.sub.j.sup.fir({right arrow over (A.sub.t.sub.a.sup.rm)}+{right arrow over (A.sub.t.sub.a.sup.cps)})].Math.*{right arrow over (A.sub.t.sub.a.sup.rm)}+{right arrow over (A.sub.t.sub.a.sup.cps1)})=0  {circle around (11)}

formula {circle around (11)} describes that the perpendicular foot from the marking points M1 to the compensated axis cuts the axis vector according to the standard coefficient n.sub.t.sub.a.sup.fir.

[0053] When the vector M.sub.t.sub.a.sup.1−M.sub.t.sub.a.sup.D, {right arrow over (A.sup.rm)} and its correction result are in a same plan, the plan intersects the cone at most twice, therefore, in the simultaneous solutions of formula {circle around (9)}, formula {circle around (10)} and formula {circle around (11)}, there are at most two solutions of n.sub.c at the same time, a final result n.sub.c and all solutions n.sub.ci satisfy a formula {circle around (12)}.


|1−n.sub.c|=min(|1−n.sub.ci|)  {circle around (12)}

[0054] For the marking points M2 and M3, perform the same steps as above, and obtain the final correction amount

[00015] A ta cps .Math. : A ta cps .Math. = ( n ct a fir .Math. A ta cps 1 .Math. ) + ( n ct a sec .Math. A ta cps 2 .Math. ) + ( n ct a thd .Math. A ta cps 3 .Math. ) ( n ct a fir + n ct a sec + n ct a thd ) .

[0055] After correction, formula {circle around (1)} is rewritten to obtain a calculation formula of FRCS as follows:


RCS.sup.F=M.sup.U+{right arrow over (A.sup.cps)}+{right arrow over (D.sup.pm)}  {circle around (13)}

wherein {right arrow over (D.sup.pm)} is resolved according to the axis vector {right arrow over (A.sup.rm′)} in the correction direction.

[0056] For the step 5: determining a height compensation of the cylinder and positioning the FRCS, in this embodiment:

in the step 1 to step 4, the human upper arm is abstracted into a standard rigid cylinder, but in an actual movement of the human body, a deformation of the human upper arm will cause inaccuracy of the abstraction, especially a change of a circumference of the upper arm will directly lead to a change of a radius of the cylinder, and then lead to a change of a distance from the positioning result of the FRCS to the marking point, therefore, it is necessary to compensate the positioning result of the FRCS.

[0057] Since a distance from a point on surface of the cylinder to a center of a cylinder top is related to a radius of the cylinder and a height from the point on surface of the cylinder to the cylinder top, error of the positioning result of FRCS caused by the change of the circumference of the upper arm can be compensated by stretching a height of the cylinder. A specific compensation method is:

for the marking point M1, D.sub.1.sup.st is used to represent a distance between FRCS and the marking point during the test period, m.sub.1 is used to represent an expectation of the distance, l.sub.t.sub.a.sup.rm1 is used to represent a scaling ratio of the vector {right arrow over (A.sub.t.sub.a.sup.rm)} at the time t.sub.a, then there is:


m.sub.1=E[D.sub.1.sup.st]  {circle around (14)}


|l.sub.t.sub.a.sup.rm1.Math.{right arrow over (A.sub.t.sub.a.sup.rm)}−(M.sub.t.sub.a.sup.1−M.sub.t.sub.a.sup.D)|=m.sub.1  {circle around (15)}

for the marking points M2 and M3, there are relationships shown in formulas {circle around (14)} and {circle around (15)}.

[0058] For any time t.sub.a during the test period, a scaling ratio of the cylinder, that is, a height compensation coefficient l.sub.t.sub.a.sup.rm is synthesized by the scaling ratios l.sub.t.sup.rm1, l.sub.t.sub.a.sup.rm2 and l.sub.t.sub.a.sup.rm3 of the three marking points M1, M2 and M3 according to:


l.sub.t.sub.a.sup.rm=Σ.sub.i=1.sup.3l.sub.t.sub.a.sup.rmi.Math.k.sup.i/(k.sup.1+k.sup.2+k.sup.3)  {circle around (16)}

wherein, k.sup.1 represents a range of the distance from the marking point M1 to FRCS during the measurement time, k.sup.2 represents a range of a distance from the marking point M2 to FRCS during the measurement time, and k.sup.3 represents a range of a distance from the marking point M3 to FRCS during the measurement time.

[0059] After compensation, the formula {circle around (13)} is rewritten to obtain a final calculation formula of FRCS:


RCS.sup.F=M.sup.U+{right arrow over (A.sup.cps)}+{right arrow over (D.sup.pm)}−(1−l.sup.rm)({right arrow over (A.sup.rm)}+{right arrow over (A.sup.cps)})  {circle around (17)}

wherein, l.sup.rm is the height compensation coefficient of the cylinder.

[0060] In summary, a process of the positioning method of FRCS is shown in FIG. 7, firstly, the human upper arm is abstracted as the rigid cylinder, the reference axis vector and the axis vector of the cylinder are determined; then, the reference axis vector is corrected by adding the correction amount {right arrow over (A.sup.cps)}, and the corrected result is ({right arrow over (A.sup.rm)}+{right arrow over (A.sup.cps)}), the translation of the reference axis vector to the axis vector {right arrow over (D.sup.pm)} is re-determined; and finally, the height of the cylinder is compensated, the height compensation coefficient l.sup.rm is determined, and the final positioning result of FRCS is obtained.

Embodiment 2

[0061] In order to verify the accuracy of the positioning method of FRCS, experiments are carried out, and the experimental results are analyzed.

[0062] Experiment

[0063] Twenty-eight adult males (18-55 years old) without upper limb dysfunction were selected as subjects to participate in the experiment, morphological parameters of the subjects are shown in Table 1. Before the experiment, all the subjects were informed of a purpose and a procedure of the experiment, and signed a consent form. In an actual measurement process, Qualisys 3D motion acquisition and analysis system was used. The system is produced by Qualisys company in Sweden and consists of motion capture camera, analysis software, acquisition unit, calibration equipment, marking ball and equipment fixing device. In the experiment, a total of 17 cameras were set, including 4 video cameras and 13 measurement cameras, the 17 cameras were evenly distributed around an experimental site, a specific distribution is shown in FIG. 8. All camera angles were adjusted to make the experimental site in centers of lens shooting ranges. A calibration accuracy of each experiment was kept below 0.7 mm.

TABLE-US-00001 TABLE 1 The morphological parameters of the 28 subjects morphological parameter average maximum minimum variance 1 weight [kg] 70.23 100 47.4 13.21 2 distance to wall [mm] 106.13 190 70 22.05 3 height [mm] 1689.40 1811 1601 46.96 4 chest girth [mm] 910.77 1160 775 92.06 5 lower chest circumference [mm] 883.07 1018 732 81.33 6 right upper arm length [mm] 318.17 341 285 13.89 7 shoulder width (width between two 391.30 433 366 19.05 acromion points) [mm] 8 chest width corresponding to a 310.90 366 259 26.09 height of a lower chest point [mm] chest thickness-chest width 9 corresponding to a height of a 221.30 259 186 21.42 midpoint of the chest [mm] 10 chest depth-a thickness at the 232.33 292 164 29.85 lower chest point [mm] 11 distance form forearm to fingertip 453.53 482 428 14.84 [mm]

[0064] A measurement of upper arm angle requires an upright trunk, and in order to make scapulae participate in the upper arm movement as little as possible, gaits of the subjects were tested. 71 marking points were pasted on the subjects, FIG. 9 shows pasting positions of the marking points on the human upper arm. During the experiment, the test period was 30 s, during the test period, the subjects made actions such as standing, walking and turning, and 3000 frames of position information of each marking point were collected.

[0065] In process of positioning and analysis of FRCS, six marking points are used for each arm, namely: acromion point, medial and lateral epicondyle points of humerus and three marking points on the upper arm. The pasting positions of the three marking points M1, M2 and M3 on the upper arm meet two rules: (1) the three points can't be in a straight line; (2) the distance between the three points should be as large as possible. In this embodiment, the pasting positions of the three points not only conform to the above two rules, but also ensure that projections of the three marking points on a cross section of the upper arm divide the cross section circle into three equal parts as much as possible. In order to simplify calculation and verify results, overhead point, neck point, upper chest point, lower chest point and thoracic vertebrae points corresponding to a height of the lower chest point can be added.

[0066] FIG. 10 shows a data acquisition result of the marking points of a subject, and FIG. 11 shows a motion trajectory of a right upper arm of a subject, it can be found that the upper arm of the subject performs not only rotational motion, but also translational motion.

[0067] Analysis of Experimental Results

[0068] Taking subject No. 1 as an example, FIG. 12 shows a relative position in trunk of the FRCS positioning result, the calculation result shows that the FRCS of right shoulder is about 5 cm closer to the left acromion, about 1 cm lower than the right acromion and 0.5 cm behind the right acromion. Table 2 shows correction {right arrow over (A.sup.cps)} of the central axis of the cylinder of subject No. 1 at some moments.

TABLE-US-00002 TABLE 2 components of the correction custom-character  of the central axis of the cylinder of subject No. 1 at some moments custom-character  ( custom-character  − custom-character  ) t/s x/mm y/mm z/mm 11.9900 −2.9456 1.9101 −0.8819 12.0000 −2.7625 1.9091 −0.8211 12.0100 −2.7484 1.6856 −0.8668 12.0200 −2.7570 1.8888 −0.8453 12.0300 −2.7441 1.7802 −0.8691 12.0400 −2.6961 1.8211 −0.8535 12.0500 −2.6920 1.9239 −0.8460 12.0600 −2.6027 2.0851 −0.7835 . . . . . . . . . . . . 16.9500 −1.69514 −3.24737 −0.93132 16.9600 −1.47387 −3.04155 −0.84052 16.9700 −1.25583 −3.20395 −0.83312 16.9800 −1.23593 −3.33113 −0.8498 Average −1.1698 0.4765 −0.5088 S.D. 1.6467 1.4763 0.5291

[0069] For subject No. 1, FIG. 13 shows the coefficient n of the three marking points M1, M2 and M3 on the upper arm to a corrected axial vector, FIG. 14 shows variation trend of the coefficient n of the three marking points M1, M2 and M3 on the upper arm to the axis vector before and after correction during the test time, table 3 shows statistical parameters of the coefficient n of the three marking points M1, M2 and M3 on the upper arm to the axis vector before and after correction.

TABLE-US-00003 TABLE 3 comparison of coefficient n before and after correction of the axis vector of the upper arm (11.99 s-16.98 s) Avg. S.D. Max. Min. Max.-Min. coefficient mark1 0.5878 0.0013 0.5910 0.5839 0.0071 n before mark2 0.3105 0.0034 0.3147 0.3023 0.0124 correction mark3 0.2395 0.0021 0.2425 0.2344 0.0081 coefficient mark1 0.5879 0.0011 0.5901 0.5861 0.0040 n after mark2 0.3095 0.0020 0.3119 0.3045 0.0074 correction mark3 0.2394 0.0015 0.2417 0.2363 0.0054

[0070] FIG. 15 shows a translation correction of a central axis position, wherein the translation {right arrow over (D.sup.pm)} is the translation correction amount of the axis vector; R is the radius of the rigid cylinder of the upper arm, and statistical parameters of R are shown in table 4.

TABLE-US-00004 TABLE 4 radius R of the upper arm R/mm (11.99 s-16.98 s) Average 40.2043 S.D. 2.323 Max. 44.3065 Min. 36.4731

[0071] FIG. 16 shows before compensation, variations of distances from the FRCS positioning result to the three marking points M1, M2 and m3 on the upper arm, variation trends of these three distances are very similar, and standard deviations of these three distances are 3.0763 mm, 2.9816 mm and 2.5329 mm respectively; FIG. 17 shows after compensation, variations of distances from the FRCS to the three marking points M1, M2 and m3 on the upper arm, and standard deviations of these three distances are reduced to 0.7202 mm, 0.4144 mm and 0.3971 mm respectively.

[0072] Table 5 shows a scaling coefficient l.sup.rm of the height of the cylinder during the compensation process.

TABLE-US-00005 TABLE 5 scaling coefficient l.sup.rm of the height of the cylinder l.sup.rm (11.99 s-16.98 s) Average 1.0000 S.D. 0.0029 Max. 1.0047 Min. 0.9909

[0073] FRCS is the rotation center of the upper arm in motion, ideally, the distances from FRCS to the three marking points M1, M2 and m3 in the upper arm should be consistent respectively, therefore, a standard deviation in the process of distance change is very important to describe a reliability of the method. FIG. 18 shows the standard deviations in the process of distance change from the FRCS positioning result to the three marking points on the upper arm for right shoulders of 28 subjects, wherein error of subject No. 27 is unreasonable, especially the error of the third marking point is much more than a sum of an average value and triple standard deviation, this may be caused by violent shaking caused by weak pasting of the marking point in the experiment, table 6 records relevant values of the standard deviations of changing distance from the FRCS to the marking point for the other 27 subjects during the test.

[0074] It can be seen from FIG. 16-18 and table 6 that for the positioning method of FRCS provided by the present invention, the standard deviations of the changing distance from the FRCS positioning result to the three marking points M1, M2 and M3 on the upper arm is between 0.081 and 2.2973, indicating that the positioning method of FRCS provided by the present invention has high accuracy and reliability, the positioning result of FRCS has better stability relative to the upper arm and trunk, and can be used to establish a more accurate human digital dynamic model and predict more accurate human posture.

TABLE-US-00006 TABLE 6 the standard deviations of changing distance from the FRCS to the three marking points for 27 subjects during the test standard deviations of changing distance from the FRCS to the three marking points standard deviation/mm average max min S.D. M1 1.1396 2.2973 0.2397 0.5763 M2 0.6718 2.0618 0.1704 0.4651 M3 0.6582 1.6031 0.081 0.4923

[0075] 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 foregoing embodiments have been described in detail, those skilled in the art should understand that they can modify recorded technical solutions in the foregoing embodiments or equivalently replaced some or all of the technical features, and these replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the present invention.