Maskinorienterad Programmering 2/2 Laborationsmoment t 2 - En Borrautomat t Genomgång g av laborationer: Programutveckling i assembler Tangentbord för borrkommando Operatör Mikrodator Anpassnings- elektronik Borrmaskin Arbetsbok för MC2, kapitel 4 Klocka 2 Borrmaskin-Robot Borrmotor med ON/OFF knapp Simulatorn för borrmaskinen Sensor för borr it topp- eller bottenläge Tryckfjäder för höjning av borr Solenoid för sänkning av borr Arbetsstycke Sensor för detektering av referensmärke på arbetsstycke (Dolt) Kretskort med effektelektronik och anslutning mot styrkort för borrmaskin. Stegmotor för rotation av arbetsstycke. New disc: Här väljer du olika arbetsstycken Control-fönster: Styrord till borrmaskinen Status-fönster: Statussignaler från borrmaskinen Indikator för Motor On Indikator för Alarm Arbetsstycke Borrade hål märks ut 3 4
Specifikation Start Operation vald Ja Utför operation Nej starta borrmotorn stoppa borrmotorn sänk borret höj borret vrid (stega) arbetsstycket ett steg vrid (stega) arbetsstycket till referenspositionen borra ett hål borra hål längs cirkeln enligt ett bestämt mönster. KEYB A= SUB () A= SUB (STOP) A=2 SUB2 (DOWN) Spara registerinnehåll på stacken A=3 SUB3 (UP) Avkoda (A) SUB4 (STEP) Återställ registerinnehåll från stacken SUB5 (DRILL) Inparameter: Kommandonummer i register A A=4 A=5 A=6 A=7 SUB6 (REFPO) SUB7 (AUTO) A>7 5 6 Styrord till borrmaskinen Utport: Drill Control 7 6 5 4 3 2 stegpuls fram/back borrmotor solenoid larmsignal Statusord från borrmaskinen Inport: Drill Status 7 6 5 4 3 2 referensposition borr uppe borr nere Anm: Statusporten t t ansluts till adress $6 i laborations- systemet t Bit 4 = : Larm på Bit 3 = : Borret sänks Bit 2 = : Borrmotorn roterar Bit = : Medurs vridning Bit : Pos flank Stegpuls Logiknivå: Aktiv hög Att göra RESET på borrmaskinen således: LDAA # ; Passiva signaler STAA $4 Bit 2 = : Borr i bottenläge Bit = : Borr i toppläge Bit = : Referensposition Logiknivå: Aktiv hög 7 8
Testförfarande Uppgift 74 Villkorlig assemblering ger korrekta portadresser ; Definiera macro SIM för test i simulator #define SIM DSInput EQU $6 ; Dip Switch Input DCtrl EQU $4 ; Drill Control Output DStatus EQU $4 ; Drill Status Input Loop LDAA DSInput ; Läs strömbrytare STAA DCtrl ; Ge styrord LDAB DStatus ; Läs status BRA Loop DSInput EQU $6 ; Dip Switch Input DCtrl EQU $4 ; Drill Control Output #ifdef SIM DStatus EQU $4 ; Drill Status Input #else DStatus EQU $6 ; Drill Status Input #endif Anm: Dip Switch Input och borrmaskin kan inte användas samtidigt i laborationssystemet (MC2). 9 Använd USE-direktivet ; DRILLDEFS.S2 DSInput EQU $6 ; Dip Switch Input DCtrl EQU $4 ; Drill Control Output # ifdef SIM DStatus EQU $4 ; Drill Status Input # else DStatus EQU $6 ; Drill Status Input # endif ; DTEST.s2 #define SIM USE DRILLDEFS.S2 Loop LDAA DSInput ; Läs strömbrytare STAA DCtrl ; Ge styrord LDAB DStatus ; Läs status BRA Loop Anm: Både DRILLDEFS och IODEFS förekommer som namn här i arbetsboken, använd endast DRILLDEFS.S2 Inledande d uppgift med borrmaskinen ) Arbetsstycket vrids till referensposition. 2) Hål borras 3) Arbetsstycket vrids medurs ett steg 4) Hål borras 5) Arbetsstycket vrids medurs ett steg 6) Hål borras 7) Arbetsstycket vrids medurs tre steg 8) Hål borras 9) En larmsignal ges som indikation på att uppgiften är klar. iera Borrmaskin )Till RefPos 2)Borra 3)Vridsteg 4)Borra 5)Vridsteg 6)Borra 7)Vrid3steg 8)Borra 9)Ge larm STOP ; Dtest2 USE DRILLDEFS.S2 ORG $ LDAA # ; Reset STAA DCtrl JSR TillRefPos JSR Borra JSR Vridsteg JSR Borra JSR Vridsteg JSR Borra JSR Vridsteg JSR Vridsteg JSR Vridsteg JSR Borra JSR GeLarm Loop: BRA Loop Vridsteg: TillRefPos: Borra: GeLarm: 2
Att vrida arbetsstycket t t Att borra ett hål Borra Utport: Drill Control 7 6 5 4 3 2 Etta: Aktiv styrsignal Nolla: Passiv styrsignal stegpuls fram/back Bit = (Pos puls): Arbetsstycket vrids Bit = : Medurs vridningsriktning Bit = : Moturs vridningsriktning b b b Uppgift 8 VridS Ange riktning Ge puls Utport: Drill Control 7 6 5 4 3 2 Inport: Drill Status 7 6 5 4 3 2 Etta: Aktiv styrsignal Nolla: Passiv styrsignal borrmotor solenoid Nolla: Passiv statussignal Etta: Aktiv statussignal b 2 b 3 b 2 =? b 3 N Starta motor Sänk borr Läs Status Borr Nere? J Höj borr borr nere b 2 Stanna motor 3 4 Att vrida arbetsstycket till referenspositionen Att bara ändra en bit i taget Inport: Drill Status 7 6 5 4 3 2 Nolla: Passiv statussignal Etta: Aktiv statussignal referensposition Bit = : Arbetsstycket är inte i referensposition Bit = : Arbetsstycket är i referensposition b =? TillR efp os Läs Status Ref Pos? N Vridsteg J * Läs nuvarande styrord LDAA DCtrl * Nollställ lämplig bit ANDA #xx * Skriv nytt styrord STAA DCtrl ;sekvensen är funktionellt ;likvärdig med: BCLR #~xx,dctrl Fungerar inte här ty porten är icke läsbar utport 5 6
Kopia av styrordet Variabel DCCopy ska hela tiden ha samma värde som DCtrl hade haft om porten varit läsbar För att nollställa en bit används nu: LDAA DCCopy ANDA #Bitmönster STAA DCtrl STAA DCCopy för att ettställa en bit används: LDAA DCCopy ORAA #Bitmönster STAA DCtrl STAA DCCopy Subrutiner för att manipulera styrregistret t t OUTONE och OUTZERO * Subrutin OUTONE. Läser kopian av * borrmaskinens styrord på adress * DCCopy. Ettställer en av bitarna och * skriver det nya styrordet till * utporten DCTRL samt tillbaka till * kopian DCCopy. * Biten som nollställs ges av innehållet * i B-registret (-7) vid anrop. * Om (B) > 7 utförs ingenting. * Anrop: LDAB #bitnummer * JSR OUTONE * Utdata: Inga * Registerpåverkan: Ingen * Anropade subrutiner: Inga DCCopy RMB bitnummer =..7 7 6 5 4 3 2 7 8 Realtid - Födöj Fördröjningar Instruktioner/ sekund Simulator Simulator Simulator STEP RUN RUN FAST Hårdvara? Fördröjningar i mekaniska delar Starta borrmotorn (vänta tills den är uppe i varv, c:a sekund) Vrid arbetsstycket ett steg (vänta tills det har vridits till rätt position, ca 2 ms) Lftb Lyft borret (vänta tills borret har kommit ovanför arbetsstycket, ca 3ms) etc 9 2
************************************** * SUBRUTIN DELAY * Beskrivning: Skapar en fördröjning om * ANTAL x 5 ms. * Anrop: LDAA #6 Fördröj 6*5ms= 3s * JSR DELAY * Indata:Antal intervall,om 5 ms i A * * Utdata: Inga * Register-påverkan:Ingen * Anropad subrutin: Ingen. ************************************** DELAY PSHA PSHX TSTA BEQ DExit ; Fördröjningsvärde noll ; Konstanten 'Konst' måste ; bestämmas... ALOOP LDX #Konst XLOOP LEAX -,X NOP CPX # BNE XLOOP DECA BNE ALOOP ; Ytterligare fördröjning DExit PULX PULA Programmerad tidsfördröjning 2 22 Använd villkorlig li assemblering #ifdef SIM #ifdef RUNFAST * Konstant vid Run Fast Konst EQU XXXX #else Bestäms experimentellt med Uppgift 9 * Konstant vid Run simulator Konst EQU YYYY #endif #else Konst EQU ZZZZ #endif Bestäms experimentellt vid laboration Tangentbord ML5 Bit 7, 7 DAV 6 5 4 3 B3 DAV: Data Valid; Statusbit som anger nedtryckt tangent b 7=: Ingen tangent är för tillfället aktiverad på tangentbordet. b 7 =: En tangent är aktiverad Bit 6-4, : Används ej. Bit 3-, B3-B: Tangentnummer; Anger aktuell tangentnedtryckning. 2 B2 B B 23 24
Uppgift 9 KEYB Läs tangentbord Borrmaskinrobot N Tangent nere J Läs tangentbord N Tangent uppe J Tangent nr Operation subrutin starta borrmotorn stoppa borrmotorn STOP KEYB 3 höj borret UP 4 rotera arbetsstycket medurs ett steg STEP 5 borra ett hål DRILL 6 stega arbetsstycket till referensposition REFPO 7 borra hål längs cirkeln enligt mönster AUTO 25 26 Rutinen Uppgift 94 A= SUB () A= SUB (STOP) A=2 SUB2 (DOWN) Spara registerinnehåll på stacken Avkoda (A) KEYB Inparameter: Kommandonummer i register A A=3 A=4 A=5 A=6 A=7 SUB3 SUB4 SUB5 SUB6 SUB7 (UP) (STEP) (DRILL) (REFPO) (AUTO) Återställ registerinnehåll från stacken A>7 ********************************** * SUBRUTIN * Beskrivning: Rutinen avgör vilken * kommandosubrutin som skall * utföras och anropar denna. * Anrop: JSR * Indata: Kommandonummer i reg A * Utdata: Inga * Reg-påverkan: A,X * Anrop subr: SUB - SUB7 ********************************** MAX EQU 7 : * giltigt värde? CMPA #MAX BHI COMEX * hopptabellens basadress LDX #JUMPTAB * offset är 2 bytes per adress ASLA * hämta subrutinens startadress LDX A,X * utför subrutin JSR,X * återvänd från kommandorutin COMEX: ********************************** * Tabell med subrutinadresser JUMPTAB FDB SUB,SUB,SUB2,SUB3 FDB SUB4,SUB5,SUB6,SUB7 ********************************** * subrutiner för test, byts senare * ut mot, STOP, DOWN etc SUB MOVB #,ParOut SUB MOVB #,ParOut SUB2 MOVB #2,ParOut SUB3 MOVB #3,ParOut SUB4 MOVB #4,ParOut SUB5 MOVB #5,ParOut SUB6 MOVB #6,ParOut SUB7 MOVB #7,ParOut 27 28
Filen MAIN.S2 STRUKTUR. Inkludera definitionsfil 2. iera systemet 3. Huvudprogram 4. Subrutinen 5. Inkludera fil (filer) med ytterligare subrutiner. 6. Plats för variabler * Definitioner USE IODEFS.S2 ORG Start ************************************ * Huvudprogram * Invänta vald operation Loop: JSR KEYB NOP * Utför vald operation JSR BRA Loop ************************************ USE KeyML5.S2 * Placera alla variabler här DCCopy RMB Att testa filen MAIN.S2 KEYB SUB MOVB #,ParOut SUB MOVB #,ParOut SUB2 MOVB #2,ParOut SUB3 MOVB #3,ParOut SUB4 MOVB #4,ParOut SUB5 MOVB #5,ParOut SUB6 MOVB #6,ParOut SUB7 MOVB #7,ParOut 29 3 Övriga, funktioner (MAINxx) testas med tangentbord och borrmaskin Rutiner och STOP * SUBRUTIN. Subrutinen startar * borrmotorn väntar därefter i 5 ms * före återhopp så att borret uppnår * rätt hastighet. * * Anrop: JSR * * Indata: Inga * Utdata: Inga * Registerpåverkan: Ingen * Anropade subrutiner: OUTONE * DELAY KEYB * SUBRUTIN STOP. Subrutinen stannar * borrmotorn. * * Anrop: JSR STOP * Indata: Inga * Utdata: Inga * Registerpåverkan: Ingen * Anropade subrutiner: OUTZERO Ändringar i huvudprogram... JUMPTAB FDB,STOP,SUB2,SUB3 FDB SUB4,SUB5,SUB6,SUB7 ********************************** * subrutiner för test, byts senare * ut mot, STOP, DOWN etc... STOP... SUB2 MOVB #2,ParOut... 3 32
Laborationsmoment 2 Pseudoparallell exekvering Mikrodator Tangentbord för borrkommando Operatör Anpassnings- elektronik Klocka Borrmaskin Processbyte En processor flera program körs samtidigt (pseudoparallellt) HDW krav: En avbrottskälla som ger regelbundna avbrott (Ex Timer) SW krav: En avbrottsrutin (SWITCH) som växlar process Puls generator 4Hz CS vid skrivning C variabler kod P data/stack P kod P2 data/stack P2 kod P3 data/stack P3 kod P4 D data/stack P4 R Q' Till processorns IRQ Ledigt... Process Process 2 Process 3 Process 4 33 34 Processtillstånd D 4Hz C Q' R IRQ CS f 4Hz p,25s25 2,5ms 4 PROC 4 IRQ PROC 3 IRQ PROC 2 PROC INIT SWITCH IRQ IRQ RUNNING READY READY READY READY RUNNING $3 variabler kod P data/stack P kod P2 data/stack P2 kod P3 data/stack P3 kod P4 data/stack P4 Ledigt... Process Process 2 Process 3 Process 4 $2FF7 $3 CCR ACCB ACCA X H X L Y H Y L PC H PC L Viktigt: I-flaggan måste vara SP T= 2,5ms 2,5ms 2,5ms μs μs μs RTI RTI RTI t 35 36
ial stack för process och processbyte : variabler ab kod P data/stack P kod P2 data/stack P2 kod P3 data/stack P3 kod P4 data/stack P4 Ledigt... Process Process 2 Process 3 Process 4 SPProc SPProc2 SPProc3 SPProc4 ProcNR Psp H Psp L P2sp H P2sp L P3sp H P3sp L P4sp H P4sp L,,2,3 Stackpekare k Process Stackpekare Process 2 Stackpekare Process 3 Stackpekare Process 4 Processnummer Running ORG TopOfStack-9 Istack: FCB $C ; ialt CCR FCB ; ialt B FCB ; ialt A FDB ; ialt t X FDB ; ialt Y FDB Start ; ialt PC ORG LDD STD Code #Istack SPProc IRQHandler: ; Spara Running stackpekare STS... ; Välj ny Running LDS... ; Återstarta RTI CCR ACCB ACCA X X H X L Y H Y L PC H PC L SP 37 38