that_one_nigga_you_k

eitaaa

Apr 16th, 2019
159
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.09 KB | None | 0 0
  1. #define in1 10
  2. #define in2 11
  3.  
  4. int s, erro, A,B,i=0;
  5. float kp;
  6.  
  7. void setup() {
  8.   // put your setup code here, to run once:
  9.   pinMode(in1, OUTPUT);
  10.   pinMode(in2, OUTPUT);
  11.   pinMode(2, INPUT);
  12.   pinMode(3, INPUT);
  13.   Serial.begin(9600);
  14. }
  15.  
  16. void loop() {
  17.   // put your main code here, to run repeatedly:
  18.  
  19.   int ia = i;
  20.  
  21.  
  22.   if(A==B){
  23.     if(A!=digitalRead(2)){
  24.       i++;
  25.       A = digitalRead(2);
  26.     }
  27.     if(B!=digitalRead(3)){
  28.       i--;
  29.       B = digitalRead(3);
  30.     }
  31.   }
  32.  
  33.   else{
  34.     if(A!=digitalRead(2)){
  35.       i--;
  36.       A = digitalRead(2);
  37.     }
  38.     if(B!=digitalRead(3)){
  39.       i++;
  40.       B = digitalRead(3);
  41.     }
  42.   }
  43.  
  44.   if(i != ia){
  45.   Serial.print("\n\n\n\n\n\n\n pulsos:  ");
  46.   Serial.println(i);
  47.   Serial.print("\n");
  48. }
  49.  
  50.   erro =
  51.  
  52.   s = kp*erro;
  53.  
  54. }
  55.  
  56. void frente(int pot, int temp){
  57.   analogWrite(in1, pot);
  58.   analogWrite(in2, 0);
  59.   delay(temp);
  60. }
  61.  
  62. void freio(int temp){
  63.   analogWrite(in1, 0);
  64.   analogWrite(in2, 0);
  65.   delay(temp);
  66. }
  67.  
  68. void re(int pot, int temp){
  69.   analogWrite(in1, 0);
  70.   analogWrite(in2, pot);
  71.   delay(temp);
  72. }
Add Comment
Please, Sign In to add comment