مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام...
Transcript of مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام...
![Page 1: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/1.jpg)
فصل چهارم
وی ژاکوبین باز-سینماتیک سرعت
مکانیکی ماهر
B. Miripour Fard Hamedan University of Technology 1
بهنام میری پور فرد
استادیار گروه مهندسی رباتیک دانشگاه صنعتی همدان
همدان، ایران
![Page 2: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/2.jpg)
B. Miripour Fard Hamedan University of Technology 2
(ارتباط فضای مفصلی و فضای دکارتی شامل موقعیت و جهت گیری)سینماتیک مستقیم
در اين فصل
.شودمیبررسیمفصلیهایسرعتبانهاییمجریخطیوایزاویهسرعتروابط
.رابطه بین این سرعتها با ژاکوبین نشان داده می شود
)()(
)(qf
q
qdX
qqJd
X
)(
![Page 3: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/3.jpg)
B. Miripour Fard Hamedan University of Technology 3
.ماتریس ژاکوبین را می توان صورت برداری مشتق معمولی یک تابع اسکالر تصور کرد
مولفه سرعت خطی و زاویه ای مجری نهایی6سرعت مفصلی و nتبدیل لحظه ای بین •
n×6یک ماتریس •
![Page 4: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/4.jpg)
B. Miripour Fard Hamedan University of Technology 4
سرعت زاویه ای
:اگر جسم صلب حول محور ثابتی دوران ناب انجام دهد
سرعت هر نقطه بر روی جسم صلب
سرعتنمایش.استدوارچارچوبیکایزاویهسرعتωامااستنقطهیکسرعتvباالرابطهدر
رایبترکلیروشیکبنابراین.استمشکلثابتغیرمحورهایحولبعدیسهحالتدرایزاویه
(پادمتقارنماتریسازاستفادهبا).دهیممیتوسعهآننمایش
![Page 5: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/5.jpg)
B. Miripour Fard Hamedan University of Technology 5
![Page 6: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/6.jpg)
B. Miripour Fard Hamedan University of Technology 6
:پادمتقارن است اگر و تنها اگرSماتریس
نمایش می دهیمSo(3)را با 3×3مجموعه همه ماتریس های پادمتقارن
:خواهیم داشت4.3عضو این مجموعه باشد، از معادله Sاگر ماتریس
jiij
iiiiiiii
SS
SSSSji
0020
![Page 7: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/7.jpg)
B. Miripour Fard Hamedan University of Technology 7
× S 3می توان دریافت که ماتریس 4.4از معادله فقط سه درایه مستقل دارد و می توان آن 3
:را به صورت زیر نشان داد
a = (ax, ay, az)اگر T یک بردار سه مولفه ای باشد، ماتریس پادمتقارنS(a) به صورت زیر تعریف
:می شود
![Page 8: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/8.jpg)
B. Miripour Fard Hamedan University of Technology 8
:مثال
: نمایش می دهیمkو jو iسه بردار پایه یکه را با
ماتریس های پادمتقارن
![Page 9: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/9.jpg)
B. Miripour Fard Hamedan University of Technology 9
:ویژگی های ماتریس های پادمتقارن
خطی استSعملگر . 1
در فضای سه بعدی bو aبرای بردارهای
در فضای سه بعدی pو aبرای بردارهای . 2
برای . 3
![Page 10: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/10.jpg)
B. Miripour Fard Hamedan University of Technology 10
nRxبرای هر بردار . 4
0SXX T
:مشتق ماتریس دوران
θباشد، بنابراین برای هر θتنها تابعی از Rبا فرض اینکه ماتریس دوران
:متعامد استθبرای هر Rچون
![Page 11: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/11.jpg)
B. Miripour Fard Hamedan University of Technology 11
مشتقگیری از رابطه باال
به صورت زیرSبا تعریف
![Page 12: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/12.jpg)
B. Miripour Fard Hamedan University of Technology 12
بیانگر این است که4.11بنابراین معادله
بنابراین ماتریس تعریف شده به صورت زیر یک ماتریس پاد متقارن است
Rبا ضرب دو طرف معادله فوق در
در آن استSمعادل ضرب ماتریس پادمتقارن Rمشتق
![Page 13: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/13.jpg)
B. Miripour Fard Hamedan University of Technology 13
ماتریس دوران پایه: مثال
بنابراین
به طور مشابه می توان نشان داد که
![Page 14: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/14.jpg)
B. Miripour Fard Hamedan University of Technology 14
:سرعت زاویه ای در حالت کلی
.حول محور دورانی که می تواند متحرک هم باشد
:به صورت پیوسته مشتق پذیر باشدRبا فرض اینکه
می توان آن را به صورت زیر نشان ω(t)یک ماتریس پادمتقارن است برای بردار یکتای S(t)چون
داد
استtسرعت زاویه ای چارچوب دوار نسبت به چارچوب ثابت در زمان ω(t)بردار
![Page 15: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/15.jpg)
B. Miripour Fard Hamedan University of Technology 15
R1اگر جهت گیری لحظه ای چارچوی یک به صفر باشد، بر اساس معادالت باال سرعت زاویه ای0
R1چارچوب یک مستقیما به مشتق.وابسته است 0
Rjمشتقبامتناظرایزاویهسرعتدادننشانبرایωi,jنوشتاراززداییابهامبرایiکنیممیاستفاده.
باالازکرد،توصیفدلخواهچارچوبهربهنسبتتوانمیراآناستآزادبردارωکهآنجاازهمچنین
:مثالکنیممیاستفادهدلخواهچارچوبدادننشانبراینویس
R2سرعت زاویه ای متناظر با .است که در چارچوب صفر توصیف شده است1
صفرنویسزیرباشد،صفرچارچوببهنسبتدورانبامتناظرایزاویهسرعتاگراختصاربرای
:مثالنویسیمنمیرا
ω2بامتناظرایزاویهسرعتR20
![Page 16: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/16.jpg)
B. Miripour Fard Hamedan University of Technology 16
مثال
با استفاده ار قاعده زنجیری
که در آن
![Page 17: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/17.jpg)
B. Miripour Fard Hamedan University of Technology 17
افزودن سرعتهای زاویه ای
![Page 18: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/18.jpg)
B. Miripour Fard Hamedan University of Technology 18
![Page 19: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/19.jpg)
B. Miripour Fard Hamedan University of Technology 19
![Page 20: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/20.jpg)
B. Miripour Fard Hamedan University of Technology 20
Sویژگی سوم ماتریس
![Page 21: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/21.jpg)
B. Miripour Fard Hamedan University of Technology 21
![Page 22: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/22.jpg)
B. Miripour Fard Hamedan University of Technology 22
سرعت خطی نقطه متصل به چارچوب متحرک
P به صورت صلب متصل است1به چارچوب
0
p
1
![Page 23: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/23.jpg)
B. Miripour Fard Hamedan University of Technology 23
0
1pp1
p0
![Page 24: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/24.jpg)
B. Miripour Fard Hamedan University of Technology 24
استخراج ژاکوبین
لینکnبازوی مکانیکی ماهر با
یافتن ارتباط بین سرعت خطی و زاویه ای مجری نهایی با بردار سرعت مفصل ها : هدف
سرعت زاویه ای مجری نهایی
![Page 25: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/25.jpg)
B. Miripour Fard Hamedan University of Technology 25
سرعت خطی مجری نهایی
:در جستجوی روابطی به صورت زیر هستیم
Jv وJω ماتریسهایn×3دو معادله فوق را می توان ترکیب کرد و به صورت یک معادله .هستند
نوشت، با فرض
![Page 26: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/26.jpg)
B. Miripour Fard Hamedan University of Technology 26
سرعت جسم برابر ژاکوبین ضرب در سرعت های مفصلی
.تعداد لینکها استn.استn×6ماتریس ژاکوبین یک ماتریس
Jωسرعت زاویه ای . 4.6.1Zi-1
امiمفصل
امiلینک
ام که در چار iام ناشی از دوران مفصل iسرعت زاویه ای لینک
ام توصیف شده استi-1چوب
![Page 27: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/27.jpg)
B. Miripour Fard Hamedan University of Technology 27
:ام کشویی باشدiاگر مفصل
:( 4.31)سرعت زاویه ای کلی مجری نهایی با استفاده از رابطه
ρi=1و اگر دورانی باشد ρi=0ام کشویی باشد iاگر مفصل
![Page 28: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/28.jpg)
B. Miripour Fard Hamedan University of Technology 28
: بنابراین نیمه پایینی ژاکوبین به صورت زیر خواهد بود
Jv=?
![Page 29: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/29.jpg)
B. Miripour Fard Hamedan University of Technology 29
سرعت خطی مجری نهایی برابر است با
با مشتق گیری زنجیری
Jvام jستون
![Page 30: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/30.jpg)
B. Miripour Fard Hamedan University of Technology 30
در مفاصل کشویی
![Page 31: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/31.jpg)
B. Miripour Fard Hamedan University of Technology 31
هارتتبرگ-بر اساس قرار داد دناویت
بنابراین برای مفصل کشویی
![Page 32: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/32.jpg)
B. Miripour Fard Hamedan University of Technology 32
در مفاصل دورانی
Riچون ثابت نیستθiبه نسبت0
![Page 33: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/33.jpg)
B. Miripour Fard Hamedan University of Technology 33
.به صورت زیر به دست می آید4.66جمله دوم معادله
![Page 34: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/34.jpg)
B. Miripour Fard Hamedan University of Technology 34
بنابراین برای مفصل دورانی
4.75یک تفسیر برای معادله
![Page 35: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/35.jpg)
B. Miripour Fard Hamedan University of Technology 35
ترکیب ژاکوبین های زاویه ای و خطی
![Page 36: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/36.jpg)
B. Miripour Fard Hamedan University of Technology 36
دورانی باشدiاگر مفصل
کشویی باشدiاگر مفصل
![Page 37: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/37.jpg)
B. Miripour Fard Hamedan University of Technology 37
مثالها
بازوی دولینکی صفحه ای4.5مثال
هر دو مفصل دورانی
![Page 38: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/38.jpg)
B. Miripour Fard Hamedan University of Technology 38
![Page 39: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/39.jpg)
B. Miripour Fard Hamedan University of Technology 39
![Page 40: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/40.jpg)
B. Miripour Fard Hamedan University of Technology 40
ژاکوبین یک نقطه اختیاری4.6مثال
در بازوی سه لینکی صفحه ای می خواهیم سرعت خطی و زاویه ای مرکز لینک دوم را بیابیم
![Page 41: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/41.jpg)
B. Miripour Fard Hamedan University of Technology 41
بازوی استنفورد4.7مثال
o3=o4=o5=o
![Page 42: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/42.jpg)
B. Miripour Fard Hamedan University of Technology 42
![Page 43: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/43.jpg)
B. Miripour Fard Hamedan University of Technology 43
![Page 44: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/44.jpg)
B. Miripour Fard Hamedan University of Technology 44
بازوی اسکارا4.7مثال
![Page 45: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/45.jpg)
B. Miripour Fard Hamedan University of Technology 45
![Page 46: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/46.jpg)
B. Miripour Fard Hamedan University of Technology 46
ژاکوبین تحلیلی
.ماتریسهای ژاکوبین به دست آمده تا اینجا، ژاکوبین های هندسی نامیده می شوند
نشان داده می شود و در آن جهت گیری مجری نهایی به صورت فشرده Ja(q)ژاکوبین تحلیلی به صورت
نشان داده می شود
d(q)بردار از مبدا چارچوب پایه به مبدا چارچوب متصل به مجری نهایی است
زوایای اویلر
![Page 47: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/47.jpg)
B. Miripour Fard Hamedan University of Technology 47
![Page 48: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/48.jpg)
B. Miripour Fard Hamedan University of Technology 48
بنابراین ژاکوبین تحلیلی را می توان از ژاکوبین هندسی محاسبه کرد
تکین های نمایشی
![Page 49: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/49.jpg)
B. Miripour Fard Hamedan University of Technology 49
تکين ها
همه سرعت های ممکن مجری نهایی ترکیب های خطی از ستون های ماتریس ژاکوبین اند
در تکین ها مجری نهایی نمی تواند در جهت معینی حرکت کند و یا حول محور
.معینی دوران کند
J(q)6×n
2
1
![Page 50: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/50.jpg)
B. Miripour Fard Hamedan University of Technology 50
دلخواه الزم است که ژاکوبین شش ستون خطی مستقل داشته باشد تا مجری نهایی بتواند به هر سرعت
.برسد
Rank (رتبه )مستقل ماتریس( یا ستونهای)تعداد سطرها : ماتریس
2Rبرای بازوی
![Page 51: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/51.jpg)
B. Miripour Fard Hamedan University of Technology 51
Rank ماتریس به پیکربندیqوابسته است و بنابراین ثابت نیست.
یا به ماتریس کمتر از بیشترین مقدار آن است، پیکربندی های تکینRankپیکربندی هایی که در آن
.نامیده می شوندتکین ها اختصار
اهمیت شناسایی تکین ها•
عدم امکان حرکت در برخی امتدادها در پیکربندی های تکین•
ای در تکین ها تغییر سرعت کوچک در مجری نهایی متناظر با سرعت های خیلی زیاد در متغیره•
مفصلی باشد
اد در ممکن است نیروها و گشتاورهای محدود در مفصل ها باعث ایجاد نیروها و گشتاورهای بسیار زی•
مجری نهایی شود
( حداکثر برد)تکین ها نقاط مرزی فضای کاری را مشخص می کند •
![Page 52: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/52.jpg)
B. Miripour Fard Hamedan University of Technology 52
تعیین تکین ها
اما حل . ن استاگر ماتریس مربعی دترمینانش به ازای برخی پیکر بندی ها صفر شود، آن پیکر بندی تکی
.مشکل استdet(J(q))=0غیر خطی معادله
دی کوپله سازی تکین ها
برای بازوهایی که مچ کروی دارند این روش قابل اعمال است
تکین ها
تکین های بازو
تکین های مچ
![Page 53: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/53.jpg)
B. Miripour Fard Hamedan University of Technology 53
تکین است اگر و فقط اگرqپیکربندی 6×6، ژاکوبین n=6حالت
در سه مفصل آخر
![Page 54: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/54.jpg)
B. Miripour Fard Hamedan University of Technology 54
مجموع پيکربندی های J11(q)|=0|بازو به شرط
ه مجموع پيکربندی های مچ بJ22|شرط (q)|=0
دی مجموع پيکر بنهای تکين بازویمکانيکی ماهر
![Page 55: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/55.jpg)
B. Miripour Fard Hamedan University of Technology 55
را نمی این گونه ژاکوبین ها لزوما ارتباط درست بین سرعتهای مجری نهایی و سرعت مفصل ها: توجه مهم.دهد و فقط راهی ساده برای تعیین تکین ها است
حالت به صورت خطی وابسته باشند، مچ در پیکربندی تکین قرار دارد، اینz3, z4, z5اگر بردارهای
همراستا باشند، یعنیz3, z5زمانی اتفاق می افتد که
θ5=0 یاᴨ
تکین های مچ
![Page 56: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/56.jpg)
B. Miripour Fard Hamedan University of Technology 56
تکین های بازو
detبرای بررسی تکین های بازو تنها الزم است J11(q) با در نظر گرفتن مرکز مچ به جایon بررسی
شود
بازوی آرنجی
![Page 57: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/57.jpg)
B. Miripour Fard Hamedan University of Technology 57
![Page 58: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/58.jpg)
B. Miripour Fard Hamedan University of Technology 58
بازوی مکانیکی ماهر کروی
را مطابق شکل قطع کرده z0مرکز مچ،
ه است زیرا این نقطه با هر دوران حول پای
ثابت می ماند
![Page 59: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/59.jpg)
B. Miripour Fard Hamedan University of Technology 59
بازوی مکانیکی ماهر اسکارا
![Page 60: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/60.jpg)
B. Miripour Fard Hamedan University of Technology 60
Rank(J11(q)<3
![Page 61: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/61.jpg)
B. Miripour Fard Hamedan University of Technology 61
نیروی استاتیکی/روابط گشتاور
![Page 62: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/62.jpg)
B. Miripour Fard Hamedan University of Technology 62
Fn
2
1
z
y
x
z
y
x
n
n
n
F
F
F
casa
cacasasa
1000
1000
122122
1221112211
2
1
FqJ T )(
مثال
![Page 63: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/63.jpg)
B. Miripour Fard Hamedan University of Technology 63
سرعت و شتاب معکوس
؟(یعنی تعداد لینکها کمتر از شش باشد)n<6مربعی نباشد و Jاگر
![Page 64: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/64.jpg)
B. Miripour Fard Hamedan University of Technology 64
. ژاکوبین قرار گیردRange Spaceدر این حالت یک راه حل وجود دارد اگر و تنها اگر در
تعلق دارد اگر و تنها اگر ( J)ژاکوبین Range Spaceبردار به
Augmented)افزودهماتریسرتبهکه(qdotبرای)داردحلزمانی4.125معادلهبنابراین
matrix)حلبرایتوانمیراگوسحذفروشمانندمتعددیروشهای.باشدژاکوبینرتبهبرابر
کرداستفادهمعادالتیچنین
![Page 65: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/65.jpg)
B. Miripour Fard Hamedan University of Technology 65
می توان از شبه معکوس راست برای حل مساله استفاده کردn>6اگر
: قضیه
Jشبه معکوس راست
![Page 66: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/66.jpg)
B. Miripour Fard Hamedan University of Technology 66
یک بردار دلخواه
![Page 67: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/67.jpg)
B. Miripour Fard Hamedan University of Technology 67
در فضای b(I-J+J)مخالف صفر، بردارهایی به فرم (I-J+J)و m<nدر حالت کلی برای
قرار داردJپوچی
بردار سرعت مفاصل باشد آنگاه زمانی که مفاصل با این =’bq(I-J+J)یعنی اگر برداری مانند
Jq’=0سرعت حرکت می کنند، مجری نهایی ثابت می ماند چون
بنابراین اگر جواب معادله باشد هم جواب معادله است که در آن
b=0اگر هدف به دست اوردن سرعت های مفصلی می نیمم باشد، آنگاه
. به دست آوردSVDشبه معکوس راست را می توان از روش
![Page 68: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/68.jpg)
B. Miripour Fard Hamedan University of Technology 68
(Manipulability)مهارت
خروجی-ورودی
پاسخ به ورودی واحد
mاین معادله یک بیضی گون rank(J)=mاگر
بعدی است که بیضی مهارت نامیده می شود
![Page 69: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/69.jpg)
B. Miripour Fard Hamedan University of Technology 69
اگر ربات درجات آزادی اضافی نداشته باشد
مهارت
کامل نباشدJمهارت زمانی صفر می شود که رتبه
![Page 70: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/70.jpg)
B. Miripour Fard Hamedan University of Technology 70
فقط -ربات دو لینکی صفحه ای
جابجایی
22
ماکزیمم مهارت
![Page 71: مراهچ لصف یوزاب نیبوکاژ-تعرس کیتامنیس رهام یکیناکمprofs.hut.ac.ir/~bmf/Chapter4-Robotic_farsi.pdf · مراهچ لصف یوزاب نیبوکاژ-تعرس](https://reader031.fdocuments.net/reader031/viewer/2022013008/5e19c32c7403327bc718c0b8/html5/thumbnails/71.jpg)
B. Miripour Fard Hamedan University of Technology 71
استفاده از مفهوم مهارت در طراحی
ل طراحی بازوی دو لینکی به گونه ای که طو: مثال
مجموع لینکها معلوم است
اگر هدف طراحی ماکزیمم مهارت باشد عبارت زیر باید ماکزیمم شود
22