Advertisement
Guest User

Untitled

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