Documente Academic
Documente Profesional
Documente Cultură
Fig. 3.7. Diagramele de stare ale elementelor de execuție, într-un ciclu de lucru
3.3.4. Modelarea părţii de comandă automată cu microcontroler
Semnificaţie Intrări/Ieşiri
Intrări-Senzori
I1-S1: Poziție braț robot sus;
I2- S2: Poziție braț robot jos;
I3- S3: Poziție braț robot dreapata;
I4- S4: Poziție braț robot stânga;
I5- S5: Poziție masă sortare la alb;
I6-S6: Poziție masă sortare la negru;
I7- S7: Poziție Gripper închis;
I8- S8: Poziție Gripper deschis;
I9: Buton Start-Stop;
I10: Senzor prezenţă piesă;
I11: Senzor culoare piesă.
Ieşiri- Relee
Q1- R1-Y1: Robot la stânga;
Q2 –R2-Y2: Robot sus;
Q3-R3-Y3: Gripper deschis;
Q4-R4-Y4: Masă rotită la alb;
Stări sistem:
Starea 1: Poziție inițială- Braț robot sus (Q2); Robot la dreapta; Gripper deschis (Q3);
Starea 2: Robot la stânga (Q1), - condiții I9; S1; S3 intrări active;
Starea 3: Prezența piesă pe stocul de intrare;
Caz1 Nu este piesă:
Stare 4: Activare timer T=2sec. după care robotul revine în starea inițială pană când pe plan
apare o piesă.
Caz 2 Este piesă:
Robotul trece la următorul pas
Starea 5: Verificare culoare;
Caz 1: Senzor culoare activ I11, adică avem culoare alb pe stocul de intrare:
Stare 6: Rotește masa la poziția Alb (Q4) - condiții I9 şi I11;
Starea7: Deschide Gripper (Q3) - condiții: I9, S1, S4, I10, I11;
Starea8 : Braț robot jos - condiții I9, S1, S4, S6, I10, I11;
Starea 9: Închide gripper (-Q3) condiții I0, S4, S8, I10, I11;
Starea10: Ridică Braț (Q2) condiții I9, S4, S7, S2, I10, I11;
Starea 11: Braț la dreapta (- Q1)- condiții I9, S1, S7, S3, S5, I11;
Starea 12: Braț jos (-Q2) - condiții I9, S4, S7, S1, I11;
Starea 13: Deschide gripper - condiții I9, S2, S4, I11;
Starea 14: Ridică braț (Q2) - condiții I9, S2, S4, I11 .
Caz 2: Senzor culoare (I11) inactive adică avem negru pe planul înclinat:
Starea15: Rotește masa la poziția Negru (-Q4) - condiții I9, I10, -I11 ;
Starea16: Deschide Gripper (Q3) condiții I9, S1, S4, I10;
Starea17: Braț robot jos (-Q2) condiții I9, S1,S4, S8, I10;
Starea 18: Inchide gripper (-Q3) - condiții I9,S4,S8, I10;
Starea 19: Ridică Braț (Q2) - condiții I9, S4, S7, S2, I10;
Starea 20: Braț la dreapta (-Q1) - condiții I9, S1, S7, S3, I10, S5;
Starea 21: Braț jos (-Q2) - condiții I9, S3, S7, S1, S7;
Starea 22: Deschide gripper (Q3) - condiții I0,S2,S3, S7;
Starea 23: Ridică braț (Q2) - condiții I9, S8, S2, S3.
Pe baza elementelor de intrare-ieşire, şi a protocolului de funcţionare impus
s-a realizat programul pentru microcontroler utilizând elemente şi funcţii logice. În figura 3.9
este prezentat programul realizat pe baza blocurilor logice şi a elementelor cu întîrziere.