Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define in1 10
- #define in2 11
- int s, erro, A,B,i=0;
- float kp;
- void setup() {
- // put your setup code here, to run once:
- pinMode(in1, OUTPUT);
- pinMode(in2, OUTPUT);
- pinMode(2, INPUT);
- pinMode(3, INPUT);
- Serial.begin(9600);
- }
- void loop() {
- // put your main code here, to run repeatedly:
- int ia = i;
- if(A==B){
- if(A!=digitalRead(2)){
- i++;
- A = digitalRead(2);
- }
- if(B!=digitalRead(3)){
- i--;
- B = digitalRead(3);
- }
- }
- else{
- if(A!=digitalRead(2)){
- i--;
- A = digitalRead(2);
- }
- if(B!=digitalRead(3)){
- i++;
- B = digitalRead(3);
- }
- }
- if(i != ia){
- Serial.print("\n\n\n\n\n\n\n pulsos: ");
- Serial.println(i);
- Serial.print("\n");
- }
- erro =
- s = kp*erro;
- }
- void frente(int pot, int temp){
- analogWrite(in1, pot);
- analogWrite(in2, 0);
- delay(temp);
- }
- void freio(int temp){
- analogWrite(in1, 0);
- analogWrite(in2, 0);
- delay(temp);
- }
- void re(int pot, int temp){
- analogWrite(in1, 0);
- analogWrite(in2, pot);
- delay(temp);
- }
Add Comment
Please, Sign In to add comment