From 825deb1a0562f8e9ef71ec97e019bb93d92f1d12 Mon Sep 17 00:00:00 2001
From: Miguel Delgado <MdelgadoL>
Date: Wed, 3 Nov 2021 13:07:17 -0600
Subject: [PATCH] Update SeguidorLineaArduino.ino

Agregar TB6612
---
 SeguidorLineaArduino/SeguidorLineaArduino.ino | 27 +++++++++++++++++++
 1 file changed, 27 insertions(+)

diff --git a/SeguidorLineaArduino/SeguidorLineaArduino.ino b/SeguidorLineaArduino/SeguidorLineaArduino.ino
index 1a11c20..3e15e1a 100644
--- a/SeguidorLineaArduino/SeguidorLineaArduino.ino
+++ b/SeguidorLineaArduino/SeguidorLineaArduino.ino
@@ -18,6 +18,13 @@ int umbral[]={1023,1023,1023,1023,1023,1023,1023,1023};
 int numSensores=8;//total de sensres en la barra
 int ir =2;//encender y apagar la barra
 
+#define PWMA  9
+#define AIN2  8
+#define AIN1  7
+#define BIN1  5
+#define BIN2  4
+#define PWMB  3
+
 
 //------------------------------------------------------------
 //----------------------INICIALIZACION------------------------
@@ -31,6 +38,20 @@ void setup() {
   pinMode(LED_BUILTIN,OUTPUT);
   //pin para controlar el encendido de la barra
   pinMode(ir,OUTPUT);
+
+  //pines para controlar motores
+  pinMode(PWMA,OUTPUT);
+  pinMode(PWMB,OUTPUT);
+  pinMode(AIN1,OUTPUT);
+  pinMode(AIN2,OUTPUT);
+  pinMode(BIN1,OUTPUT);
+  pinMode(BIN2,OUTPUT);
+  //establecer direccion de los motores
+  digitalWrite(AIN1,HIGH);
+  digitalWrite(AIN2,LOW);
+  digitalWrite(BIN1,HIGH);
+  digitalWrite(BIN2,LOW);
+  
   digitalWrite(ir,HIGH);//Encendemos la barra
   calibracion();
 }
@@ -48,9 +69,15 @@ void loop() {
     Serial.print("\t");
   }
   Serial.println(pos);
+
+  acelerar(50,50);
   delay(100);
 }
 
+void acelerar(int motIzq, int motDer){
+  analogWrite(PWMA,motIzq);
+  analogWrite(PWMA,motDer);
+}
 
 
 /*