Maskinorienterad Programmering 21/211 Genomgång g av laborationer: Programutveckling i assembler Arbetsbok för MC12, kapitel 4 1 Laborationsmoment t 2 - En Borrautomat t Tangentbord för borrkommando Operatör Mikrodator Anpassnings- elektronik Borrmaskin Klocka 2
Borrmaskin-Robot Borrmotor med ON/OFF knapp 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. 3 Simulatorn för borrmaskinen New disc: Här väljer du olika arbetsstycken Indikator för Motor On Control-fönster: Styrord till borrmaskinen Status-fönster: Statussignaler från borrmaskinen Indikator för Alarm Arbetsstycke Borrade hål märks ut 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. 5 START Init KEYB1 COMMAND COMMAND Spara registerinnehåll på stacken Avkoda (A) Inparameter: Kommandonummer i register A A= A=1 A=2 A=3 A=4 A=5 A=6 A=7 A>7 SUB (START) SUB1 (STOP) SUB2 (DOWN) SUB3 (UP) SUB4 (STEP) SUB5 (DRILL) SUB6 (REFPO) SUB7 (AUTO) Återställ registerinnehåll från stacken 6
Styrord till borrmaskinen Utport: Drill Control 7 6 5 4 3 2 1 stegpuls fram/back borrmotor solenoid larmsignal Bit 4 = 1: Larm på Bit 3 = 1: Borret sänks Bit 2 = 1: Borrmotorn roterar Bit 1 = 1: Medurs vridning Bit : Pos flank Stegpuls Logiknivå: Aktiv hög Att göra RESET på borrmaskinen således: LDAA # ; Passiva signaler STAA $4 --- --- 7 Statusord från borrmaskinen Inport: Drill Status 7 6 5 4 3 2 1 referensposition borr uppe borr nere Anm: Statusporten t t ansluts till adress $6 i laborations- systemet t Bit 2 = 1: Borr i bottenläge Bit 1 = 1: Borr i toppläge Bit = 1: Referensposition Logiknivå: Aktiv hög 8
Testförfarande Uppgift 74 DSInput EQU $6 ; Dip Switch Input DCtrl EQU $4 ; Drill Control Output DStatus EQU $41 ; Drill Status Input Loop LDAA DSInput ; Läs strömbrytare STAA DCtrl ; Ge styrord LDAB DStatus ; Läs status BRA Loop 9 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 #ifdef SIM DStatus EQU $41 ; Drill Status Input #else DStatus EQU $6 ; Drill Status Input #endif Anm: Dip Switch Input och borrmaskin kan inte användas samtidigt i laborationssystemet (MC12). 1
Använd USE-direktivet ; DRILLDEFS.S12 DSInput EQU $6 ; Dip Switch Input DCtrl EQU $4 ; Drill Control Output # ifdef SIM DStatus EQU $41 ; Drill Status Input # else DStatus EQU $6 ; Drill Status Input # endif ; DTEST1.s12 #define SIM USE DRILLDEFS.S12 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.S12 11 Inledande d uppgift med borrmaskinen 1) 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. START Initiera Borrmaskin 1)Till RefPos 2)Borra 3)Vrid1steg 4)Borra 5)Vrid1steg 6)Borra 7)Vrid3steg 8)Borra 9)Ge larm STOP ; Dtest2 USE DRILLDEFS.S12 ORG $1 LDAA # ; Reset STAA DCtrl JSR TillRefPos JSR Borra JSR Vrid1steg JSR Borra JSR Vrid1steg JSR Borra JSR Vrid1steg JSR Vrid1steg JSR Vrid1steg JSR Borra JSR GeLarm Loop: BRA Loop Vrid1steg: TillRefPos: Borra: GeLarm: 12
Att vrida arbetsstycket t t Uppgift 8 Utport: Drill Control 7 6 5 4 3 2 1 Etta: Aktiv styrsignal Nolla: Passiv styrsignal stegpuls fram/back Bit = 1 (Pos puls): Arbetsstycket vrids Bit 1 = : Medurs vridningsriktning Bit 1 = 1: Moturs vridningsriktning b 1 b b 1 Vrid1S Ange riktning Ge puls 13 Att borra ett hål Borra Utport: Drill Control 7 6 5 4 3 2 1 Etta: Aktiv styrsignal Nolla: Passiv styrsignal b 2 1 b 3 1 Starta motor Sänk borr borrmotor solenoid Läs Status Inport: Drill Status 7 6 5 4 3 2 1 Nolla: Passiv statussignal Etta: Aktiv statussignal b 2 =1? b 3 N Borr Nere? J Höj borr borr nere b 2 Stanna motor 14
Att vrida arbetsstycket till referenspositionen TillR efp os Inport: Drill Status 7 6 5 4 3 2 1 Nolla: Passiv statussignal Etta: Aktiv statussignal Läs Status referensposition Bit = : Arbetsstycket är inte i referensposition Bit = 1: Arbetsstycket är i referensposition b =1? Ref Pos? N Vrid1steg J 15 Att bara ändra en bit i taget * 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 16
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 DCCopy RMB 1 17 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 bitnummer =..7 7 6 5 4 3 2 1 18
Realtid - Födöj Fördröjningar Instruktioner/ sekund Simulator Simulator Simulator Hårdvara STEP RUN RUN FAST? 1 1 1 19 Fördröjningar i mekaniska delar Starta borrmotorn (vänta tills den är uppe i varv, c:a 1 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 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. ************************************** 21 DELAY PSHA PSHX TSTA BEQ DExit ; Fördröjningsvärde noll ; Konstanten 'Konst' måste ; bestämmas... ALOOP LDX #Konst XLOOP LEAX -1,X NOP CPX # BNE XLOOP Programmerad tidsfördröjning DECA BNE ALOOP ; Ytterligare fördröjning DExit PULX PULA 22
Använd villkorlig li assemblering #ifdef SIM #ifdef RUNFAST * Konstant vid Run Fast Konst EQU XXXX #else Bestäms experimentellt med Uppgift 9 simulator * Konstant vid Run Konst EQU YYYY #endif #else Konst EQU ZZZZ #endif Bestäms experimentellt vid laboration 23 Tangentbord ML15 7 6 5 4 3 2 1 DAV B3 B2 B1 B Bit 7, DAV: Data Valid; Statusbit som anger nedtryckt tangent b 7=1: 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. 24
Uppgift 91 KEYB1 Läs tangentbord N Tangent nere J Läs tangentbord N Tangent uppe J 25 Borrmaskinrobot START Init Tangent nr Operation subrutin starta borrmotorn START 1 stoppa borrmotorn STOP 3 höj borret UP KEYB1 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 COMMAND 26
Rutinen COMMAND Uppgift 94 START Init KEYB1 COMMAND Spara registerinnehåll på stacken Avkoda (A) COMMAND Inparameter: Kommandonummer i register A A= SUB (START) A=1 SUB1 (STOP) A=2 SUB2 (DOWN) A=3 A=4 A=5 A=6 A=7 SUB3 SUB4 SUB5 SUB6 SUB7 (UP) (STEP) (DRILL) (REFPO) (AUTO) A>7 Återställ registerinnehåll från stacken 27 ********************************** * SUBRUTIN COMMAND * Beskrivning: Rutinen avgör vilken * kommandosubrutin som skall * utföras och anropar denna. * Anrop: JSR COMMAND * Indata: Kommandonummer i reg A * Utdata: Inga * Reg-påverkan: A,X * Anrop subr: SUB - SUB7 ********************************** MAX EQU 7 COMMAND: * 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,SUB1,SUB2,SUB3 FDB SUB4,SUB5,SUB6,SUB7 ********************************** * subrutiner för test, byts senare * ut mot START, STOP, DOWN etc SUB MOVB #,ParOut SUB1 MOVB #1,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 28
Filen MAIN1.S12 STRUKTUR 1. Inkludera definitionsfil 2. Initiera systemet 3. Huvudprogram 4. Subrutinen COMMAND 5. Inkludera fil (filer) med ytterligare subrutiner. 6. Plats för variabler * Definitioner USE IODEFS.S12 ORG Start --- --- ************************************ * Huvudprogram * Invänta vald operation Loop: JSR KEYB1 NOP * Utför vald operation JSR COMMAND BRA Loop ************************************ COMMAND --- --- --- USE KeyML15.S12 * Placera alla variabler här DCCopy RMB 1 29 Att testa filen MAIN1.S12 START Init KEYB1 COMMAND SUB MOVB #,ParOut SUB1 MOVB #1,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 3
Övriga, funktioner (MAINxx) testas med tangentbord och borrmaskin START Init KEYB1 COMMAND 31 Rutiner START och STOP * SUBRUTIN START. Subrutinen startar * borrmotorn väntar därefter i 5 ms * före återhopp så att borret uppnår * rätt hastighet. * * Anrop: JSR START * * Indata: Inga * Utdata: Inga * Registerpåverkan: Ingen * Anropade subrutiner: OUTONE * DELAY * SUBRUTIN STOP. Subrutinen stannar * borrmotorn. * * Anrop: JSR STOP * Indata: Inga * Utdata: Inga * Registerpåverkan: Ingen * Anropade subrutiner: OUTZERO Ändringar i huvudprogram... JUMPTAB FDB START,STOP,SUB2,SUB3 FDB SUB4,SUB5,SUB6,SUB7 ********************************** * subrutiner för test, byts senare * ut mot START, STOP, DOWN etc START... STOP... SUB2 MOVB #2,ParOut... 32
Laborationsmoment 2 Pseudoparallell exekvering Tangentbord för borrkommando Operatör Mikrodator Anpassnings- elektronik Borrmaskin Klocka 33 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 Init variabler kod P1 data/stack P1 kod P2 data/stack P2 kod P3 data/stack P3 Process1 Process 2 Process 3 Puls generator 4Hz CS vid skrivning C1 kod P4 1 1D data/stack P4 R Q' Till processorns IRQ Ledigt... Process 4 34
Processtillstånd 4Hz 1 1D C1 RUNNING READY Q' R IRQ CS 1 f 4Hz p,25s25 2,5ms 4 IRQ PROC 4 PROC 3 PROC 2 PROC 1 IRQ IRQ IRQ READY READY READY RUNNING INIT SWITCH T= 2,5ms 2,5ms 2,5ms μs μs μs RTI RTI RTI t 35 Init variabler Viktigt: I-flaggan måste vara kod P1 data/stack P1 kod P2 data/stack P2 kod P3 Process1 Process 2 Process 3 $2FF7 CCR ACCB ACCA X H SP data/stack P3 X L $3 kod P4 data/stack P4 Ledigt... Process 4 $3 Y H Y L PC H PC L 36
Init variabler ab kod P1 data/stack P1 kod P2 data/stack P2 kod P3 data/stack P3 Process1 Process 2 Process 3 SPProc1 SPProc2 SPProc3 SPProc4 P1sp H P1sp L P2sp H P2sp L P3sp H P3sp L P4sp H P4sp L Stackpekare k Process 1 Stackpekare Process 2 Stackpekare Process 3 Stackpekare Process 4 kod P4 data/stack P4 Process 4 ProcNR,1,2,3 Processnummer Running Ledigt... 37 Initial stack för process och processbyte : ORG TopOfStack-9 Istack: FCB $C ; Initialt CCR FCB ; Initialt B FCB ; Initialt A FDB ; Initialt t X FDB ; Initialt Y FDB Start ; Initialt PC ORG LDD STD Code #Istack SPProc CCR ACCB ACCA X X H X L Y H Y L PC H PC L SP IRQHandler: ; Spara Running stackpekare STS... ; Välj ny Running LDS... ; Återstarta RTI 38