;File : C:\SOCAPEL\INDEXC2.AUT ;SEQUENCEUR DU MOTEUR DE LA ROUE DE FILTRE C2 1 JUIL. 2002 ;******************************************** ;COMMANDES MANUELLES: ;- START et STOP par bouton poussoir. ;- Positionnement des 12 filtres par roue codeuse. ;SECURITE D'ASSERVISSEMENT: ; Si SEUIL1 est atteind (30 deg.), g‚nŠre un STOP et un PWROFF. ;COMMANDE AMONT: ;- INITIALISATION: ; - SETPAR INMASK = 2001 => inhibe la commande manuelle. ; - SBOUT1 = 8 => temoin de commande amont. ; - GOTO 240 + attente OUT1 (OUTPUT >2) = 0 ; Le s‚quenceur execute un INIABS = 0 … la position ; PHIB = 0 du r‚solver (position du filtre 1). ;- POSITIONNEMENT DES FILTRES ; VIA SEQUENCEUR: ; D‚placement en valeur absolue, reste dans le tour moteur, ; peut effectuer 11/12 de tour. ; - Filtre 1: GOTO 19 + attente OUT1 = 1 ; - Filtre 2: GOTO 35 + attente OUT1 = 1 ; - Filtre 3: GOTO 51 + attente OUT1 = 1 ; - Filtre 4: GOTO 67 + attente OUT1 = 1 ; - Filtre 5: GOTO 83 + attente OUT1 = 1 ; - Filtre 6: GOTO 99 + attente OUT1 = 1 ; - Filtre 7: GOTO 115 + attente OUT1 = 1 ; - Filtre 8: GOTO 131 + attente OUT1 = 1 ; - Filtre 9: GOTO 147 + attente OUT1 = 1 ; - Filtre 10: GOTO 163 + attente OUT1 = 1 ; - Filtre 11: GOTO 179 + attente OUT1 = 1 ; - Filtre 12: GOTO 195 + attente OUT1 = 1 ;COMMANDE MANUELLE: ;- PRESSION SUR LE BOUTON STOP POUR PRENDRE LA MAIN ; IN15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 ;32768 16384 8192 4096 2048 1024 512 256 128 64 32 16 8 4 2 1 ;START SOFT \EA F12 F11 F10 F9 F8 F7 F6 F5 F4 F3 F2 F1 STOP ; OUT7 OUT6 OUT5 OUT4 OUT3 OUT2 OUT1 OUT0 ; \EA SOFT QI MES AB BASE DEC SET CINACL >DFFF SET CINMAS >2001 ; INACTL INMASK ; (ETAT) (VALID) ; IN0 STOP ; ******** 0 = IFINPT 32768 >DFFF >0000 SI START GOTO 3 >DFFF >0000 FAUX: STOP GOTO 470 >DFFF >0000 VRAI: MONTAGE MOTEUR STOP 0 >DFFF >0000 WSTATA 2048 >DFFF >0000 RESSTS 0 >DFFF >0000 SBOUT0 8 >DFFF >0000 LIBERE CDE MAN. WAIT 30 >DFFF >0000 PWROFF 0 >DFFF >0000 END 0 >DFFF >8000 ; IN1 FILTRE 1 ; ************ 16 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 2 >DFFF >0001 END 0 >DFFF >1FFF 19 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 4 >DFFF >2001 0 DEG. (0+3+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3FFD FAUX END 0 >DFFF >2001 VRAI ; IN2 FILTRE 2 ; ************ 32 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 4 >DFFF >0001 END 0 >DFFF >1FFF 35 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 1371 >DFFF >2001 30 DEG.(1365+5+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3FFB FAUX END 0 >DFFF >2001 VRAI ; IN3 FILTRE 3 ; ************ 48 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 8 >DFFF >0001 END 0 >DFFF >1FFF 51 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 2742 >DFFF >2001 60 DEG. (2730+11+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3FF7 FAUX END 0 >DFFF >2001 VRAI ; IN4 FILTRE 4 ; ************ 64 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 16 >DFFF >0001 END 0 >DFFF >1FFF 67 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 4110 >DFFF >2001 90 DEG. (4095+14+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3FEF FAUX END 0 >DFFF >2001 VRAI ; IN5 FILTRE 5 ; ************ 80 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 32 >DFFF >0001 END 0 >DFFF >1FFF 83 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 5474 >DFFF >2001 120 DEG.(5460+13+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3FDF FAUX END 0 >DFFF >2001 VRAI ; IN6 FILTRE 6 ; ************ 96 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 64 >DFFF >0001 END 0 >DFFF >1FFF 99 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 6837 >DFFF >2001 150 DEG. (6825+11+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3FBF FAUX END 0 >DFFF >2001 VRAI ; IN7 FILTRE 7 ; ************ 112 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 128 >DFFF >0001 END 0 >DFFF >1FFF 115 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 8199 >DFFF >2001 180 DEG. (8190 +8+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3F7F FAUX END 0 >DFFF >2001 VRAI ; IN8 FILTRE 8 ; ************ 128 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 256 >DFFF >0001 END 0 >DFFF >1FFF 131 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 9564 >DFFF >2001 210 DEG. (9555+8+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3EFF FAUX END 0 >DFFF >2001 VRAI ; IN9 FILTRE 9 ; ************ 144 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 512 >DFFF >0001 END 0 >DFFF >1FFF 147 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 10932 >DFFF >2001 240 DEG. (10920+11+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3DFF FAUX END 0 >DFFF >2001 VRAI ; IN10 FILTRE 10 ; ************** 160 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 1024 >DFFF >0001 END 0 >DFFF >1FFF 163 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 12297 >DFFF >2001 270 DEG. (12285+1+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >3BFF FAUX END 0 >DFFF >2001 VRAI ; IN11 FILTRE 11 ; ************** 176 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 2048 >DFFF >0001 END 0 >DFFF >1FFF 179 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 13659 >DFFF >2001 300 DEG. (13650+8+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >37FF FAUX END 0 >DFFF >2001 VRAI ; IN12 FILTRE 12 ; ************** 192 = WAIT 1000 >DFFF >0001 ATTENTE 0.3 S IFINPT 4096 >DFFF >0001 END 0 >DFFF >1FFF 195 = CALL 420 >DFFF >2001 PID ET RELAY ON EAMOV 15020 >DFFF >2001 330 DEG. (15015+4+1) WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >2001 PID ET RELAY OFF IFINPT 16384 >DFFF >2001 SI CDE SOFT END 0 >DFFF >2FFF FAUX END 0 >DFFF >2001 VRAI ; IN13 STOP EQUART D'ASSERVISSEMENT ; ********************************* 208 = STOP 0 >DFFF >0000 WSTATA 2048 >DFFF >0000 RESSTS 0 >DFFF >0000 PWROFF 0 >DFFF >0000 END 0 >DFFF >0001 ; IN15 START + INITIALISATION ; *************************** 240 = SETEX2 -2 >DFFF >0001 X2 = -1 CALL 420 >DFFF >0000 PID ET RELAY ON PWRONI 0 >DFFF >0000 243 = CALL 300 >DFFF >0000 CENTRAGE ROUE ERMOV 4 >DFFF >0000 ANGLE (0 MOT.) => F1 WSTATA 2048 >DFFF >2001 CALL 400 >DFFF >0000 PID ET RELAY OFF WAIT 3000 >DFFF >0001 ATTENTE 1 S INCEX2 1 >DFFF >0001 IFGEZ2 0 >DFFF >0001 GOTO 241 >DFFF >0001 FAUX: 2EME CENTRAGE INIABS 0 >DFFF >0000 VRAI: CONTINUE SBOUT1 4 >DFFF >0001 QUITANCE INIT. WAIT 30 >DFFF >0001 ATTENTE 10 MS IFINPT 16384 >DFFF >0001 SI CDE SOFT END 0 >DFFF >1FFD FAUX END 0 >DFFF >2001 VRAI ; CENTRAGE DE LA ROUE ; ******************* 300 = LDEX1 >25 >DFFF >0001 GHARGE PHIB IFGEZ1 0 >DFFF >0001 SI PHIB POSITIF GOTO 308 >DFFF >0001 FAUX ERUN -500 >DFFF >2001 VRAI 304 = LDEX1 >25 >DFFF >2001 GHARGE PHIB IFGEZ1 0 >DFFF >2001 SI PHIB >0 GOTO 312 >DFFF >2001 FAUX: FIN GOTO 304 >DFFF >2001 VRAI: BOUCLE 308 = ERUN 500 >DFFF >2001 VRAI 309 = LDEX1 >25 >DFFF >2001 GHARGE PHIB IFGEZ1 0 >DFFF >2001 SI PHIB >0 GOTO 309 >DFFF >2001 FAUX: BOUCLE 312 = STOP 0 >DFFF >0001 ARRET WSTATA >800 >DFFF >0001 RESSTS 0 >DFFF >0001 RET 0 >DFFF >0001 ; DESACTIVE LE PID ; **************** 400 = WAIT 600 >DFFF >0001 ATTENTE 100 MS SBOUT0 1 >DFFF >0001 LACHE LE RELAY WAIT 600 >DFFF >0001 ATTENTE 10 MS SETEX1 >500000 >DFFF >0001 KPOS = 0 EXEC1 >2A >DFFF >0001 SETPAR SETEX1 >510000 >DFFF >0001 KVIT = 0 EXEC1 >2A >DFFF >0001 SETPAR SETEX1 >520000 >DFFF >0001 KTEGR = 0 EXEC1 >2A >DFFF >0001 SETPAR SBOUT1 2 >DFFF >0001 MESURE PERMISE WAIT 30 >DFFF >0001 ATTENTE 10 MS RET 0 >DFFF >0001 ; ACTIVE LE PID ; ************* 420 = SBOUT0 2 >DFFF >0001 MESURE INTERDITE WAIT 30 >DFFF >0001 ATTENTE 10 MS SETEX1 >510064 >DFFF >0001 KVIT = 100 EXEC1 >2A >DFFF >0001 SETPAR SETEX1 >5000C8 >DFFF >0001 KPOS = 200 EXEC1 >2A >DFFF >0001 SETPAR SETEX1 >527FFF >DFFF >0001 KTEGR = 32767 EXEC1 >2A >DFFF >0001 SETPAR SBOUT1 1 >DFFF >0001 TIRE LE RELAY WAIT 300 >DFFF >0001 RET 0 >DFFF >0001 ; DIAGRAMME DE BOD ; **************** ; Utilisation de l'entr‚e potentiometrique comme commande de ; de position variable 432 = SETEX1 0 >DFFF >0001 DEBUT DE BOUCLE LDEX2 >52 >DFFF >0001 VALPOT DANS X2 EXEC2 >7 >DFFF >0001 EAMOV WSTATA >800 >DFFF >0001 IFGEZ1 1 >DFFF >0001 SI FIN DE BOUCLE GOTO 433 >DFFF >0001 END 0 >DFFF >0001 ; CONSTANTE DE TEMPS ; ****************** 440 = SETEX1 0 >DFFF >0001 DEBUT DE BOUCLE ERUN 32767 >DFFF >0001 WSTATA >800 >DFFF >0001 ERUN -32767 >DFFF >0001 WSTATA >800 >DFFF >0001 IFGEZ1 1 >DFFF >0001 SI FIN DE BOUCLE GOTO 441 >DFFF >0001 END 0 >DFFF >0001 ; ALLER ET RETOUR POR REGLAGE PID ; ******************************* ; POUR DEMARRER => GOTO 450 ; POUR ARRETER => SETEX1 1 450 = PWRONS 0 >DFFF >0001 DEBUT DE BOUCLE WAIT 300 >DFFF >0001 ATTENTE 100 MS SETEX1 0 >DFFF >0001 ERMOV 1365 >DFFF >0001 + 1/12 DE TOUR WSTATA >800 >DFFF >0001 - 1/12 DE TOUR WAIT 300 >DFFF >0001 ATTENTE 100 MS ERMOV -1365 >DFFF >0001 WSTATA >800 >DFFF >0001 WAIT 300 >DFFF >0001 ATTENTE 100 MS (PID) IFGEZ1 1 >DFFF >0001 SI FIN DE BOUCLE GOTO 453 >DFFF >0001 END 0 >DFFF >0001 ; MONTAGE DU MOTEUR SUR LE BLOC RF ; ******************************** ; POSITIONNE ET MAINTIEN L'AXE AU ZERO PHIB. ; MISE EN MARCHE => RESET PUIS PRESSER SUR: ; START (MAINTENIRE) PUIS STOP ; ARRET => PRESSER STOP AVANT DE SERRER LES VIS ; APPUYER SUR RESET AVANT DE TOURNER LA ROUE 470 = SETEX1 >510018 >DFFF >0000 KVIT = 24 EXEC1 >2A >DFFF >0000 SETPAR SETEX1 >500012 >DFFF >0000 KPOS = 18 EXEC1 >2A >DFFF >0000 SETPAR SETEX1 >530000 >DFFF >0000 INERT = 0 EXEC1 >2A >DFFF >0000 SETPAR PWRONS 0 >DFFF >0000 WAIT 300 >DFFF >0000 CALL 300 >DFFF >0000 CENTRAGE WINPUT 1 >DFFF >0000 ATTENTE STOP SETEX1 >510000 >DFFF >0000 KVIT = 0 EXEC1 >2A >DFFF >0000 SETPAR SETEX1 >500000 >DFFF >0000 KPOS = 0 EXEC1 >2A >DFFF >0000 SETPAR SETEX1 >533A98 >DFFF >0000 INERT = 32767 EXEC1 >2A >DFFF >0000 SETPAR WAIT 3000 >DFFF >0000 ATTENTE 1 S END 0 >DFFF >0001 ; DIMINUTION DE FEXT ; ****************** ; 480 = SETEX1 >56FF88 >DFFF >0001 FEXT = -120 ; INCEX1 1 >DFFF >0001 DIMINUE -FEXT ; EXEC1 >2A >DFFF >0001 SETPAR ; WAIT 1 >DFFF >0001 ATTENTE 6.66 MS ; IFGEZ1 >56FFFF >DFFF >0001 SI FEXT >= 0 ; GOTO 481 >DFFF >0001 FAUX: BOUCLE ; RET 0 >DFFF >0001