Координаталар жүйесін арнайы таңдау және Денавит-Хартенберг әдісімен координаталар жүйесін біртекті түрлендіру.
Көптеген белгілі манипуляторларда ілгерілемелі кинематикалық жұптардың айналмалы және бағыттаушы осьтері, ереже бойынша, параллельді немесе өзара перпендикуляр. Осьтер мен бағыттауыштардың осындай жағдайларына Д-Х ұсынысы басқа әдістермен салыстырғанда қолданған кезде артықшылықтары бар. Денавит-Хартенберг әдісіне сәйкес, і және і-1 буындарынан тұратын, кинематикалық жұптарға арналған ортогональді координаталар жүйесі келесі түрде таңдалып алынады: Zi-1 координатасының осі айналмалы кинематикалық жұп үшін айналу осінің бойымен немесе ілгерілемелі жұп үшін бағыттауыш бойымен бағытталады (7-сурет). Буынмен қатты байланысқан OiXiYiZi координаталар жүйесінің басы Zi және Zi-1 осьтерінде жатқан жазықтыққа перпендикуляр және Zi осінің қиылысында немесе Zi және Zi-1 осьтерінің қиылысу нүктелерінде, ал егер Zi және Zi-1 осьтері бір-бірімен беттесетін немесе бір-біріне параллель болса і, і-1 буындарынан тұратын кинематикалық жұптың кез-келген нүктесінде жатады.
Тіреуішпен байланысқан координаталар жүйесінің басы қандай-да бір буынмен тіреуіштен түзілген кинематикалық жұпта бағыттауыш немесе осьтің кез-келген нүктесінде жатады. Xi осі қатынасына сәйкес Zi және Zi-1 осьтеріне перпендикуляр немесе егер, олар параллель болса, Zi және Zi-1 осьтеріне тұрғызылған жалпы нормальдың бойымен бағытталған. Жалпы жағдайда, Xi осінің бағыты Zi және Zi-1 осьтеріне перпендикулярдың бойымен және осы перпендикулярдың Zi-1 осімен қиылысу нүктесінен таңдалынып алынады. Егер Zi және Zi-1 осьтері бір жазықтықта жататын және қиылысатын немесе беттесетін болса, онда Xi осі осы жазықтыққа перпендикуляр бағытталады. X0 осі жұмысшы органы жаққа бағытталады. Yi осі оң жақ координаталар жүйесін түзетіндей етіліп бағытталады. Қарпығыш құрылғымен (манпулятордың соңғы буынымен) байланысқан OnXnYnZn координаталар жүйесін таңдау жалпы ережеге бағынбайды және ұстағыштың центрі деп аталатын нүктеде басымен немесе осьтердің еркін бағдарлануымен жұмысшы органының сипаттамалық нүктесінде таңдалынады.
· Xi осінің бойымен есептелініп алынған, Zi және Zi-1 осьтерінің арасындағы ең қысқа ара қашықтық ai деп белгіленген және і-ші буынның ұзындығын береді.
· і және і-1 координаталар жүйесінің бастары арасындағы Zi-1 осінің бағыты бойынша өлшенетін ара қашықтық буындық ара қашықтық si деп аталады.
· Xi осінің Xi-1 осіне көлбеулігі qi деп белгіленеді және мүшеленулердегі бұрыштардың векторының құраушысы болып табылады.
· Zi және Zi-1 осьтерінің бір-біріне қатысты бағдары iбұралу бұрышы векторының компоненті болып табылады.
Д-Х ұсынысы бойынша көрсетілген төрт айнымалылар: ai,si,qi, i і-буынының і-1 буынға қатысты орнын толығымен сипаттайды.
Егер әрбір буынмен байланысқан координаталар жүйесі Денавит-Хартенберг ұсынысы бойынша енгізілген болса, онда біртекті түрлендіру матрицасын 4х4 тік төртбұрышты матрица түрінде оңай алуға болады. Геометриялық мағынасында біртекті түрлендіру матрицасы і-1-нші буынмен байланысқан і-1 координаталар жүйесіне қатысты і-нші буынмен байланысқан і-нші координаталар жүйесінің орнын анықтайды. Біртекті түрлендіру матрицасымен сипатталатын толық біртекті түрлендіру қарапайым қозғалыстардың – айналулар мен жылжулардың композициясы түрінде алынуы мүмкін.
Демек, біртекті түрлендіру матрицасы координаталар жүйесінің беттескенінше қарапайым қозғалыс матрицасының көбейтіндісі ретінде алынуы мүмкін. Қарапайымқозғалыстардыңбіртектіматрицаларыналуүшін Д-Х ұсынысынқолданамыз.
7-суреттекинематикалықжұптүзетін і және і-1 буындарыкөрсетілген. БуындардыңәрқайсысыменДенавит-Хартенбергбойыншакоординаталаржүйесібайланысқан.
Егер әрбір жағдайда, келесі қарапайым қозғалыстар көмегімен і-1 жүйені і-нші жүйемен беттестірсек, онда әр қозғалыс біртекті түрлендіру матрицасы арқылы сипатталады:
7-сурет. Координаталаржүйелері осьтерінтаңдау
1. Xi-1 осі Xi осіне параллель болғанша і-1 жүйесін Zi-1 осін айнала qi бұрышына бұру. Бұлқозғалысқарапайымайналудыңбіртектіматрицасыменсипатталуымүмкін
(2.1)
(Мұнда және әрі қарай С және S арқылы сәйкесінше Cos және Sin тригонометриялық функциялары белгіленген);
2. Xi және Xi-1 осьтері бір түзудің бойында жатпайынша немесе параллель болғанша алынған жүйені Zi-1 осінің бойымен si шамасына орын ауыстыру. Сонда, қарапайымығысудыңбіртектіматрицасы
(2.2)
түріндеболады;
3. Екі координаталар жүйелерінің басы қосылғанша жоғарыда алынған жүйені Xi-1 осінің бойымен аi өлшеміне ығыстыру. Бұлжағдайдақарапайымығысудыңбіртектіматрицасы
(2.3)
тең болады;
4. Координаталар жүйелері толығымен қосылғанша координаталар жүйесін Xi-1 осін айнала бұрышына бұру. Бұл қозғалыс біртекті айналу матрицасымен сипатталады
. (2.4)
Сонымен, жоғарыда көрсетілген төрт қарапайым қозғалыстардың әрқайсысына төрт тік төртбұрышты біртекті түрлендіру матрицасы сәйкес келеді.
Толық біртекті түрлендіру матрицасы Ai келешекте і-нші және і-1-нші буындардан тұратын кинематикалық жұптың матрицасы деп аталынады. Осы матрица алынған матрицалардың (2.1-2.4) көбейтіндісі ретінде анықталады:
. (2.5)
Көбейтулер нәтижесінде і-ші кинематикалық жұптың матрицасы алынды
. (2.6)
Егер ri=(xi, yi, zi, 1)T – і-ші буынның координаталар жүйесіндегі бір нүктенің біртекті координатасының кеңейтілген векторы, ал ri-1=(xi-1,yi-1,zi-1,1)T – і-1 буынының координаталар жүйесіне қатысты сол нүктенің біртекті координатасының кеңейтілген векторы болса, онда келесі түрдегі матрицалық теңдік дұрыс болады:
ri-1 = Ai-1i r i . (2.7)
Ai (2.6) матрицасы элементтерінің ішінде бірқозғалысты кинематикалық жұп үшін тек бір ғана элемент айнымалы болып табылады, ал басқа үшеуі кинематикалық жұптың тұрақты геометриялық көрсеткіштерін сипаттайды. Механизм буындары нүктелерінің жылдамдықтары мен үдеулері (2.7) теңдікті дифференциалдау арқылы анықталады. Сондықтан, Ai матрицасын дифференциалдау кезінде қолданылған кейбір өрнектер төменде келтірілген.
Жалпы түрде еркін жалпыланған координата qi бойынша Ai матрицасынан туынды
(2.8)
тең болады.
Мұндағы WI Zi-1 осінің бойымен ілгерілемелі кинематикалық жұп болған жағдайда мына түрде анықталады:
(2.9)