TVZ Mechatronics Team / Mbed 2 deprecated URS_LV11_HMI_3zad

URS - LV11 - HMI - 3. zadatak - Servo

Dependencies:   mbed

main.cpp

Committer:
dfraj
Date:
2022-01-24
Revision:
2:71767bf8e14d
Parent:
1:a59853df510d

File content as of revision 2:71767bf8e14d:

#include "mbed.h" 
 
Serial nextion(p28, p27); 
PwmOut servo(p21);            
 
char buffer[20]; 
int znak = 0; 
 
uint8_t pozicija = 0;
 
void Rx_interrupt(void){
    char c;
 
    if(nextion.readable()) {
        c = nextion.getc();
        buffer[znak] = c;
        znak++;
        if ((znak >= 2) && (buffer[znak-1] == 0x0d)) {  
            pozicija = 0;
            for(int i = 0; i < 3; i++) {
                if(buffer[i] == 0x0d) break;
                pozicija = pozicija * 10 + (buffer[i] - 48);
            }
            servo.pulsewidth_us(5.56*pozicija+1000);
            memset(buffer,0,strlen(buffer));
            znak = 0;
        }
    }
} 
 
int main(){
    nextion .attach(&Rx_interrupt, Serial::RxIrq); 
    servo.period(0.02);    
    while (1) {
        wait(1.0);     
    }
}