Petrenko Vyacheslav Ivanovich (RU),Петренко Вячеслав Иванович (RU),Tebueva Fariza Bilyalovna (RU),Тебуева Фариза Биляловна (RU),Gurchinskij Mikhail Mikhajlovich (RU),Гурчинский Михаил Михайлович (RU)
申请号:
RU2018142829
公开号:
RU0002700118C1
申请日:
2018.12.04
申请国别(地区):
RU
年份:
2019
代理人:
摘要:
FIELD: control systems.SUBSTANCE: invention relates to control systems and can be used in creation of setting devices for copying control systems implemented in form of exoskeleton with non-stiff attachments to operator's body. Disclosed is a method for indirect measurement of rotation angles in operator's joints, based on use for measurement of exoskeleton with kinematic scheme, similar to kinematic scheme of human hand, links of which are located along operator's hands, fixed on operator's body with the help of rigid and non-rigid fixtures, rotation angles measurement θ in exoskeleton kinematic pairs. Additionally measuring lB1-B2 is operator shoulder length, lB2-B3 is the length of the forearm of the operator, calculating the Cartesian coordinates vectors of the shoulder joint B1; wrist joint B3, operator's hand center B4, elbow articulation of exoskeleton C2 by solving the kinematics direct problem, values of projections of vector B1B3 are calculated, connecting the shoulder and wrist joints of the operator, calculating the distance between the shoulder and wrist joints of the operator lB1-B3, calculating semi -perimeter p of triangle formed by shoulder, elbow and wrist joints of operator, calculating distance lK2-B2 from center of circle K2, formed by virtual rotation of elbow joint operator around axis passing through shoulder and wrist joints, and elbow joint operator by formula:calculating distance lB1-K2 between shoulder joint and center of circle K2 by formula: calculating coordinates of point K2 by formula: where λ is ratio, in which point K2 divides section B1B3, calculating two versions of B(n)2a and B(n)2b vectors of values of Cartesian coordinates of elbow joint by solving system of equations: where xK2, yK2, zK2 – Cartesian coordinates of point K2; An, Bn, Cn, Dn are coefficients of plane perpendicular to section B1B3 and passing through point K2; xB1B3, yB1B3, zB1B3 are values of projections of vector B1B3 on Cartesian coordinate system axis; xC2