Академический Документы
Профессиональный Документы
Культура Документы
1.0
Vezrlk:
DC_servo_E240_a2
Bevezets
A DC szervo sorozat vezrli step/dir rendszer krnyezetben hasznlhatk szervomotorok
meghajtsra. A sorozat elemei:
A vezrlkben egy ATXmega tpus mikrokontroller dolgozik. Egy USB adapterrel PC-hez
lehet kapcsolni, s a PC-n fut kliens programmal lehet a vezrl paramtereit lltani. A
program grafikusan kirajzolja a vezrl fontosabb jeleinek idbeli lefutst, gy a hangols s
diagnosztika klnsebb szakrtelem nlkl is megoldhat. A mikrokontroller programjt is
ezen az USB kapcsolaton keresztl tudjuk jabbra cserlni, illetve szksg esetn tovbbi
szolgltatsokkal lehet bvteni a vezrl tudst.
1 Csatlakoz bektsek
Logikai tpnak 12-15V, minimum 0,5A rammal terhelhet stabilizlt, vagy stabilizlatlan
tpegysget alkalmazzunk. Kivlan megfelel egy 12V 1A-es kapcsolzem adapter, vagy
9V-os szekunder tekerccsel rendelkez transzformtorhoz kapcsolt didahddal s egy 2200
F-os elektrolit kondenztorral kialaktott stabilizlatlan tpegysg.
A krtyn optocsatolk fogadjk a STEP, DIR s ENA jeleket, s egy optocsatol tranzisztora
adja a PC fel az RDY kszenlti-, vagy hibajelet. A bemeneteken a didkkal sorban van egy
470 Ohmos ellenlls, gy 5V-os jelszint esetn nem kell kls ramkorltoz ellenlls.
Magasabb jelszint esetn kls ellenlls sorba ktsvel kell belltani a kb. 5 mA
didaramot.
Ha kzvetlenl az LPT portra csatlakozunk, akkor pl. az X tengely STEP s DIR jeleinek
bektse a kvetkez lehet:
2,4,6 s 8-as lb sszektve az LPT 20-as lbra (GND)
1-es az LPT 3-as lbra (STEP)
3-as az LPT 2-es lbra (DIR)
3 Els zemi prba
Az els alkalommal a belltst s hangolst a mechaniktl fggetlen motorral rdemes
prblgatni. A szervo kr egy tlzott ersts megadsval begerjedhet, s mechanikai
srlseket okozhat a gpnkn.
3.1.1 Csatlakozk
Ellenrizzk a tpfeszltsgek csatlakozit. Fordtott polarits maradand krokat okozhat a
vezrlben.
Dugjuk a helyre az USB adaptert gy, hogy a vezrlpanelon 1-essel s fehr pttyel jelzett
lbra kerljn az adapter 1-es lba. Ha ez nincs jellve, akkor a 4 plus tskesor azon szls
lba, amelyik be van ktve. A 4-es lb az adapteren nincs bektve. A helyesen feldugott
adapter alkatrszoldala pofval lefel ll a vezrl alkatrsz oldalhoz viszonytva.
3.1.2 Bekapcsols
Elszr kapcsoljuk be a logikai tpfeszltsget. A LED piros felvillansa utn lass zld
villogssal jelzi, hogy a vezrl zemksz.
Most kapcsoljuk be a motor tpfeszltsget. Ha nincs kln kapcsolja, nem tragdia, mehet
egytt a logikai tpfeszltsggel. Akkor sincs baj, ha felcserljk a sorrendet s elszr a
motortpot kapcsoljuk be. A tpfeszltsg bekapcsolsi sorrendje teht mindegy, akr egytt,
akr kln adjuk r a vezrlre.
Az els hasznlat eltt telepteni kell az adapter FTDI chip meghajt programjt. A telept
programot letlthetjk a kvetkez helyrl:
http://freecnc.hu/Downloads/USB_driver/CDM20802_Setup.exe
Vlasszuk ki az adapter cmt, ami valsznleg a lista utols eleme lesz. A paramterek
gyrilag a kvetkez rtkekre vannak lltva:
,
akkor vagy rossz COM cm van belltva, vagy az USB adapter nincs csatlakoztatva a PC-
hez.
http://freecnc.hu/Downloads/E240_projekt/TuningDC_2_install.exe
A program folyamatos fejleszts alatt van, a Bellts s Auto tuning jelenleg le van
tiltva, mg nem hasznlhat.
5.1 A kperny egyes mezi
5.1.1 PID
Arnyos ersts: a PID algoritmus P tagjnak erstst adjuk meg itt lebegpontos
formban. Els alkalommal clszer 1.0-ra lltani, s innen nvelve megkeresni a gerjeds
hatrt.
Integrl ersts: a PID algoritmus I tagjnak erstst adjuk meg itt lebegpontos formban.
Derivtor ersts: a PID algoritmus D tagjnak erstst adjuk meg itt lebegpontos
formban.
Holt sv:
Az itt belltott svot a hibajel 0 krl figyelmen kvl hagyja az algoritmus, gy tekinti,
mintha 0 lenne a hibajel.
Kimeneti szr:
A beavatkoz jelre egy alultereszt szr idllandja. Csak klnleges esetekben
hasznlhat, mert a kr stabilitst egy jabb idlland rontja.
Encoder (ppr) :
A motoron alkalmazott enkder felbontsa impulzus/fordulat dimenziban. Az enkder 4x
zemmdban dolgozik, teht pldul egy 512 cpr-es (ciklus/fordulat) enkdernl ide 2048-at
rjunk. Szerepe csupn a pillanatnyi fordulat rtknek kijelzsnl van.
Fatlis hibaszint:
Ha a hibajel rtke meghaladja az itt belltott rtket, akkor a vezrl letilt, s az RDY
kimenet ezt jelzi a mozgsvezrlnek. A mozgs vezrl ezt a jelzst rzkelve lelltja a
tbbi tengelyt is. Ha az rtke 0, akkor ez a funkci ki van kapcsolva.
Szervo frekvencia
Mintavtelezsi frekvencia Hz-ben. Az algoritmus ilyen frekvencival vesz mintt a
parancspozcibl s az enkder pozcibl. A vett mintk alapjn szmolja ki a szksges
beavatkozsokat.
PWM frekvencia
A motormeghajt hd impulzus szlessg modullt (PWM) jelnek alapfrekvencija. A
kitltsi tnyez 0 s 95% kztti rtkeket vesz fel.
Max. PWM%
Az itt megadott rtkre lehet korltozni a PWM kitltsi tnyezjt. Hasznos lehet ez a
paramter, ha eltr feszltsg motorokat zemeltetnk kzs tpegysgrl. A kisebb
feszltsg motorokat gy meg tudjuk vdeni a megengedettnl nagyobb feszltsggel trtn
tlterhelstl.
ram idlland
ram limit
Nvleges ram
Max. ram
Max hmrsklet
5.1.3 Tesztjel
Kikapcsols
Ez a norml zem, ebben az llsban nincs hangol jel.
Ngyszg
Szervo rendszerek ltalnosan elfogadott hangolsi mdszere az egysgugrsra adott vlasz
vizsglata. A ngyszg hangol jelalak egy pozci egysgugrs vezrlst ad az
ramkrknek. Az aktulis pozcibl indulva, az amplitd paramterben megadott pozcit
r be a pozci regiszterbe, ami szinte egy elmleti egysgugrsnak felel meg. A peridus id
leteltvel az amplitd negatv rtkt rja a pozci regiszterbe, s ez ismtldik
periodikusn.
Frsz
Az amplitd s a peridusid alapjn szmolhat sebessggel forgatja a motort jobbra-balra.
Ez a jelalak egy sebessg egysgugrssal gerjeszti a vezrlt.
Trapz
Mint a frsz jelalaknl, csak irnyvlts eltt negyed peridusnyi idre megll a motor. Ez is
sebessg egysgugrsnak megfelel gerjesztst ad a vezrlnek.
Peridus
A hangol jel peridusideje ezred msodpercben kifejezve.
Amplitd
A hangol jelalak amplitdja enkder osztsban kifejezve. Erre az amplitdra hatssal van
az ttt. szorz, teht az itt belltott amplitdt megszorozza az tttel szorzval, s az lesz
az elmozduls mrete.
5.1.4 Szervo
ttt. szorz
Egy berkez step impulzus egy enkder osztsnyi elmozdulst eredmnyez. Ha nagy az
enkder felbontsa, akkor egy adott t megttelhez tbb step impulzus szksges. Ms
oldalrl kzeltve, adott sebessg mozgshoz nagyobb felbonts enkder esetn nagyobb
frekvencij step impulzus sorozatra van szksg. Gyakori problma, hogy a mozsvezrl
program nem tud elegenden nagy frekvencij step jelet szolgltatni. Ekkor lehet hasznos az
tttel szorz, mert minden bejv step jelet mintegy megszorozza az itt megadott rtkkel,
gy a rendszer jobban illeszkedik egy nagyobb felbonts enkderhez.
ttt. oszt
Nincs implementlva, tervezett szolgltats.
Klds azonnal
Ha a jell ngyzetben pipa van, akkor egy paramter mdostsa utn az Enter billentyre
elkldi a paramter rtkt a vezrlnek.
Kirs
A nyomgomb hatsra a kpernyn lthat paramtereket elkldi a vezrlnek.
Beolvass
A nyomgomb hatsra beolvassa a paramtereket a vezrlbl s kirja a kpernyre.
Szervo ON
A nyomgomb benyomott llapotban engedlyezzk a vezrl mkdst. Ha kiengedjk a
nyomgombot, akkor letiltjuk a vezrlt, ilyenkor a motornak nincs tartsa.
Tandem
Master
DIR+ magas
RDY magas
Step+ magas
ENA pozitv
5.1.6 Firmware
SON
Zld esetn a szervo engedlyezve van, piros esetn le van tiltva. Csak mkd oszcilloszkp
esetn mutatja a helyes llapotot.
CUR
Zld esetn a szervo motorrama a megengedett hatron bell van. Ha pirosra vlt, akkor
tartsan tllptk a megengedett motorramot. Ha idnknt rvid idre felvillan, akkor a
terhels cscsokban (induls, meglls, irnyvlts) rvid idre a motorram tllpi a
megengedett rtket. Csak mkd oszcilloszkp esetn mutatja a helyes llapotot.
ERR
Zld a norml zemet jelenti. Ha pirosan vilgt, akkor az a vezrl hiballapott mutatja,
letiltott a tl nagy pozci hiba miatt, vagy ms rendellenessget rzkelt a vezrl programja.
Ford (1/perc)
5.1.8 Oszcilloszkp
6 Frisstsek
A vezrl mikroprogramja a kliens programmal lecserlhet. A javtsok s jabb verzik a
kvetkez knyvtrbl tlthetk le:
http://freecnc.hu/Downloads/E240_projekt
A frisstst a Krtya -> Upgrade menpont elindtsval kezdjk. A frissts eltt kapcsoljuk
ki az oszcilloszkpot a Jelalakok megjelentse gombbal.
Az Upgrade fjl sor vgn tallhat kis gombbal keressk meg a WEB-rl letlttt frisst
fjlt. Az Elkszts gomb megnyomsval a program beolvassa az elbb kivlasztott fjl
tartalmt, s elkszti a frissts letltst a vezrlbe.
Elegend a Flash frissts, gy nem vltoznak meg a vezrl paramterei. Most nyomjuk meg
az Upgrade gombot, s a szintjelz mutatni fogja a letlts elrehaladst.
Nagyobb strukturlis vltozsok esetn azt kln jelezzk, hogy az EEprom tartalmt is
frissteni kell. Ebben az esetben olvassuk be a vezrlbl az aktulis paramtereket, s rjuk ki
egy fjlba. A frissts utn ennek a fjlnak a tartalmval tudjuk visszalltani a vezrl korbbi
paramtereit.
7 Hangols
Az albbi plda a DC_Servo_XX vezrl egy lehetsges hangolsra mutat pldt.
A step/dir interfsz hangolsa teljesen hasonl, csak a differencil ersts rtke az itt
mutatott pldhoz kpest 100-ad rsze. Teht amikor itt pldul 2-t lltunk be a differencil
erstsnek, akkor a step/dir interfsz-nl 0.02-nek felel meg.
1. Lps
Alaphelyzetben az arnyos ersts 1-re van lltva. A tesztjeleknl lltsunk be 2000-es
peridust s 500-as amplitdt. Kapcsoljuk be a ngyszg jelalakot, ami 0.5 Hz-es
frekvencij ngyszggel, ms szval egysgugrssal gerjeszti a vezrlt.
A jelalakokbl ltjuk, hogy nagyon nagy hibval kveti a motor a kapott vezrlst.
2. Lps
Az arnyos ersts nvelsvel keressk meg a gerjeds hatrt. Kis lpsekben emeljk az
erstst, s csak addig menjk felfel, amg csak ersen lengedez vlaszt ltunk, a tnyleges
gerjeds krokat okozhat a mechanikban.
3. Lps
Most a differencil erstssel keressk meg azt a hatrt, amikor az enkder jelbl eltnik a
lengedezs, s mg feljebb emelve az erstst a tllvs is megsznik.
4. Lps
Most adjunk megint arnyos erstst addig, hogy jra lengedezve lljon be a motor.
5. Lps
Az elz kt lpst ciklikusan ismtelve emeljk az erstseket egszen addig, hogy bells
nyugalomban maradjon a motor, ne legyen a nyugalmi helyzet krl pici oszcillci sem
(morgs). Kzben a hibajel sugr rzkenysgt vigyk fel maximumra, hogy ltni lehessen a
nyugalmi llapot legkisebb zavar mozgst is. Ilyenkor a kperny egy pixelnyi eltrse egy
enkder osztst jelent.
7. Lps
Most adjunk egy kis integrl erstst, annyit, hogy a bells utn mg nulln maradjon a
hibajel.
8. Lps
Most kapcsoljuk t a tesztjelet trapzra s az amplitdt nveljk meg akkorra, hogy a motor
mozgsa alatt legyen hibajel.
(FOLYT.KV)