Girdeji:
- AI-iň kömegi bilen öňe / ters kinematikany we traýektoriýa meýilnamalaşdyryş meselelerini gurmak we çözmek ukyby
- Robotyň bilelikdäki çäklerini, tizligini we tizlenme çäklendirmelerini teklip edip, howpsuz orbitany öndürmek ukyby
- AI tarapyndan öndürilen kinematiki we traýektoriýa çykyşyny san we fiziki taýdan barlamak ukyby
Robot golunyň ujundaky tutawajyny kosmosyň belli bir nokadyna, belli bir ugra getirmek; Simpleönekeý ýaly görünýär, ýöne aňyrsynda kinematiki deňlemeler, bilelikdäki çäkler, ýekelik we traýektoriýa meýilnamasy bar. Bu ýerde mekatronika inereneri trigonometriýany, çyzykly algebrany we dolandyryş teoriýasyny bilelikde ulanýar. Emeli intellekt bu işde güýçli kömekdir: öňe kinematika deňlemelerini döredip biler, ters kinematika üçin çözgüt çemeleşmelerini teklip edip biler, tizlik / tizlenme çäklendirmelerine görä traýektoriýany parametrleşdirip biler. Şeýle-de bolsa, robotika fiziki töwekgelçiligi iň ýokary bolan mehatronikanyň ugurlaryndan biridir; AI tarapyndan döredilen burç yzygiderliligi roboty tassyklamazdan iberilse, gol özüne, daşky gurşawa ýa-da operatora degip biler. Bu bölümde kinematikany we traýektoriýa meýilnamasyny AI bilen nädip gurmalydygyny we barlamalydygyny göreris.
Öňe we ters kinematika
Öňe kinematika (FK): Bilelikdäki burçlar belli bolsa, ahyrky effektoryň ýagdaýyny we ugruny tapmak. Diňe bir çözgüt bar, göni.
Ters kinematika (IK): Ahyrky funksiýanyň islenýän ýagdaýy belli bolsa, muny üpjün etjek bilelikdäki burçlary tapyň. Adatça birden köp çözgüdi bar (tirsek ýokary / aşak ýaly), käwagt hiç hili çözgüdi ýok (ýetip bolmajak nokat), käwagt çäksiz çözgütleri bar (ýekelik).
düşünjesi
giriş
çykyş
Çözgütleriň sany
Öň kinematikasy
bogun burçlary
Iň ýokary pozisiýa / ugrukdyrma
ýeke
Ters kinematika
Iň ýokary pozisiýa / ugrukdyrma
bogun burçlary
Birnäçe / ýok / çäksiz
Iki bogunly planar gol üçin ters kinematikany AI-de gurup we aşakdaky ýaly el bilen barlap bolýar:
npdef inverse_kinematik_2r (x, y, L1, L2) hökmünde numpy import ediň: "" "2 bogunly planar gol üçin IK. radianlarda burçlary yzyna gaýtaryp berýär (tirsegiň aşagy)." "" r2 = x ** 2 + y ** 2 # Elýeterliligi barlamak: iş ýerindäki nokatmy? eger np.sqrt (r2)> (L1 + L2) ýa-da np.sqrt (r2) <abs (L1 - L2) bolsa: ValueError ("Nokat elýeterli iş meýdanynyň daşynda") cos_t2 = (r2 - L1 ** 2 - L2 ** 2) / (2 * L1 * L2) cos_t2 = n0t2c np.arkkos dereje yzy (ters_kinematik_2r (1.0, 1.0, 1.0, 1.0)) # ~ (0.0, 90.0)
Bu ýerdäki kritiki setirler, AI-iň köplenç bökýän ýeri: elýeterliligi barlamak (iş ýerindäki nokat) we "np.clip" (tegelek ýalňyşlyk sebäpli arkos girişiniň ± 1-den geçmeginiň öňüni alýar). Bu iki gorag bolmasa, kod NaN öndürer ýa-da nädogry nokatda heläk bolar.
Maslahat: IK çözgüdi soranyňyzda, AI-ä "elýeterlilik gözegçiligini goşuň we arkos girişini gysgaltmagy çäklendiriň" diýiň. Bu iki setir, meýdanda iň köp kelle agyry döredýän sessiz ýalňyşlyklaryň öňüni alýar.
Bilelikdäki çäkler, ýekelik we köp çözgüt
Hakyky robotyň her bir bogunynda burç aralygy (meselem -170 ° - + 170 °), tizlik we tizlenme çäkleri bar. IK matematiki taýdan dogry burç berse-de, bu burç bogunyň fiziki çäginden daşda bolsa ulanyp bolmaz. Mundan başga-da, robot käbir konfigurasiýalarda ýeke-täklige düşýär: iki ok deňleşdirilýär, bir dereje erkinlik ýitýär we bilelikdäki tizlikler kiçijik ujy hereketi üçin çäksizlige gitmäge synanyşýar.
Şonuň üçin diňe kadr çözgüdi ýeterlik däl; Her çözgüt kabul ederlikli süzgüçden geçmeli:
def solution_gecerli_mi (acilar_deg, limits_deg): "" "agyry: [t1, t2, ...], çäkler: ({amine}, {amax}) "yzyna dogry", "OK" çäklerinden başga =
AI IK-nyň "matematiki" çözgüdini berip biler; emma bilelikdäki çäkler we ýekelikden gaça durmak ulgamyňyza mahsusdyr we gyssagly mazmun hökmünde berilmelidir.
Orbitany meýilleşdirmek
Roboty A nokatdan B nokadyna almak iki burçuň arasynda göni çyzyk çekmek däl. Birden tizligiň üýtgemegi mehaniki zarba we titremäni döredýär. Munuň ýerine ýumşak profiller ulanylýar: trapezoidal tizlik tertibi (hemişelik tizlenme - hemişelik tizlik - hemişelik tizlenme) ýa-da S-egri (tizlenme hem çäkli bolan has ýumşak). AI traýektoriýa döredilende, maksat, dowamlylyk we çäklendirmeler bermeli.
npdef trapez_yorunge (q0, q1, v_max, a_max, dt = 0.01) görnüşinde numpy import ediň: "" "Bir bogun üçin trapezoidal tizlik profilini görkezýär. positionagdaý massiwi yzyna gaýtarylýar." t_speed ** 2 eger 2 * aralyk_speed> aralyk: # üçburçluk profil (v_max baryp bolmaýar) t_speed = np.sqrt (aralyk / a_max) t_constant = 0.0 v_peak = a_max * t_speed else: t_constant = (aralyk - 2 * aralyk + t_constant t = np.arange (0, T, dt) # ... her t üçin ýagdaýy hasaplamak (tizlenme / hemişelik / tizlenme fazalaryna esaslanýar) t, T, v_peak, dowamlylygy, vz = trapezoidal_trajectory (0.0, 90.0, v_max = 60.0, a_max = 120.0) {s deg / s ")
Bu ýerde logiki barlag şu: aralyk gysga bolsa, motor hiç haçan v_max ýetip bilmez we profil trapezoidaldan üçburçlyga öwrüler. AI bu ýagdaýy sypdyrsa, nädogry hereket gysga hereketler üçin hasaplanar. Kody belli bir baha bilen synap görüp bilersiňiz (mysal üçin, gaty gysga aralyk).
Gowşak gyssagly / güýçli teklip
Gowşak: "Robot goluny A-dan B-a çenli alyp barýan traýektoriýa ýazyň." (Çäklendirme ýok: tizlik çäklimi? Tizlenme? Bilelikdäki aralyk? Kör çykyş.) Güýçli: "6 okly robot üçin umumy meýdanda nokat-nokat traýektoriýasyny dörediň. Her bogun üçin tizlik çägi 90 deg / s, tizlik tizligi bolsa, tizlik tizligi 180 deg / s. üçburçly profiliň içine düş
Barlamak: Simulýasiýadan Robota çenli
AI tarapyndan döredilen traýektoriýa, robota gitmezden ozal şu tertipde barlanýar:
- San: Her ädimiň bilelikdäki burçy, tizligi we tizlenmesi çäklerde barmy?
- Çaknyşyk: traýektoriýa ugrunda gol özi ýa-da daşky gurşaw bilen çaknyşýarmy (mümkin bolsa göz öňüne getiriň / simulasiýa ediň)?
- Ulareke-täklik: Orbit ýeke-täk sebitden geçýärmi (Jacobakobyň kesgitleýjisi nola ýakynlaşýarmy)?
- Hardwareuwaş enjam synagy: Roboty pes tizlikde işlediň (meselem, 10%) we wizual gözegçilik ediň.
- Graduallyuwaş-ýuwaşdan tizlik ýokarlanýar: Hemme zat barlanandan soň tizlik nominal bahasyna ädim-ädim ýokarlanýar.
Üns beriň: Täze traýektoriýa bilen roboty ilkinji gezek işe girizeniňizde, tizligi üýtgetmek elmydama pes bolmaly we E-stop elýeterli bolmaly. AI çykyşy “matematiki taýdan dogry” bolsa-da, fiziki gurnamada ofset, ters ok ýa-da kabel çekilmegi diňe haýal synag bilen ýüze çykar.
Mini Case
Awtomatlaşdyryş inereneri Ece, AI-den saýlama we ýer goýmasy üçin bilelikdäki giňişlikde traýektoriýa kody soraýar. AI trapezoidal profil öndürýär, ýöne Ece gysga aralyk hereketini synagdan geçirende wagtyň negatiwdigini görýär: kod v_max baryp bolmaýan üçburçluk profilini işlemedi. Ece muny "aralyk gysga bolsa, üçburç profiline düş" haýyşnamasyny aýdyp düzedýär. Soňra AI tarapyndan berlen bilelikdäki burçlary öz çäk tablisasyna garşy barlamak funksiýasy arkaly işledýär we 5-nji nokadyň bir wagtda + 125 °, şol bir wagtyň özünde + 120 ° bolandygyny anyklaýar. Ol traýektoriýany täzeleýär we oňa gözegçilik edýär, bu gezek roboty 10% tizlik bilen işledýär. Birinji tapgyrda, tutawajyň stola gaty ýakynlaşýandygyny we Z ofsetini düzedýändigini görýär. AI birnäçe minutda iş meýilnamasyny yzyna gaýtardy; emma üç aýry tassyklama (üçburçluk profil, bilelikdäki çäk, haýal synag) üç aýry hakyky meseläni ýüze çykardy.
Umumy ýalňyşlyklar
- IK çözgüdini bilelikdäki çäkler we elýeterlilik gözegçiligi bolmazdan ulanmak.
- Arcos / arcsin ýazgylaryny kesmek däl-de, tegelek ýalňyşlyk ýüze çykan halatynda NaN öndürmek.
- Tizligi / tizlenmäni çäklendirmezden we mehaniki zarba döretmezden orbitany talap etmek.
- Ulareke-täklik zolaklaryna ähmiýet bermezlik we bilelikdäki tizligiň artmagyna ýol bermek.
- Gysga aralykda trapezoidal-üçburç profiliň geçişinden geçmek we nädogry wagty hasaplamak.
- Ilkinji orbital synagy doly tizlikde we E-stop girişsiz geçirmek.
Gysgaça
- Öňe sürülýän kinematikanyň ýekeje çözgüdi bar; ters kinematika köp, ýok ýa-da çäksiz çözgütleri öndürip biler.
- IK çözgütleri hökmany suratda bilelikdäki çäkler, elýeterlilik we ýekelik taýdan süzülýär.
- Traýektoriýa meýilnamasy; Trapezoidal ýa-da S-egri ýaly ýumşak, çäkli gabat gelýän profilleri ulanýar.
- Gysga aralykda profil trapezoidden üçburçlyga üýtgeýär; bu kod bilen işlenmeli.
- AI matematikany çaltlaşdyrýar; Çäkler we fiziki gurnama konteksti haýal etmän girmeli.
- Täze traýektoriýa elmydama pes tizlikli we elýeterli “E-stop” bilen ilkinji gezek işleýär.
Programma meselesi
Iki ýa-da üç bogunly gol modelini saýlaň (hakyky ýa-da hyýaly baglanyşyk uzynlygy we bilelikdäki çäkler bilen). AI ters kinematika funksiýasyny we bu kontekst bilen traýektoriýa meýilleşdirijisini döretmegini isläň. Soňra: (1) IK çykyşyny belli bir maksat bilen el bilen barlaň (burçlary yzyna goýup, FK bilen şol bir nokada gaýdyp gelýärsiňizmi), (2) koduň iň bolmanda bir elýeterli nokady we bir çäkden ýokary bir nokat berip, olary ele alýandygyny barlaň, (3) gysga aralykda orbital wagtyň ýerlikli bolandygyny barlaň. Kodyň birinji wersiýasynda näçe tassyklama meselesini tapandygyňyzy we haýsy gatlagyň hersini tutandygyny ýazyň.