     pinMode(trigPin, OUTPUT); // Sets the trigPin as an Output
     pinMode(echoPin, INPUT); // Sets the echoPin as an Input
 
+
+    pinMode(motorEnablePin, OUTPUT);
+    analogWrite(motorEnablePin, 255);
+
     // Motor
     pinMode(motorPin1_1, OUTPUT);
     pinMode(motorPin1_2, OUTPUT);
-    pinMode(motorPin1_speed, OUTPUT);
-    pinMode(motorPin1_A, INPUT);
 
     pinMode(motorPin2_1, OUTPUT);
     pinMode(motorPin2_2, OUTPUT);
-    pinMode(motorPin2_speed, OUTPUT);
-    pinMode(motorPin2_A, INPUT);
-
-    /*
-    pinMode(motorPin3_1, OUTPUT);
-    pinMode(motorPin3_2, OUTPUT);
-    pinMode(motorPin3_speed, OUTPUT);
-    pinMode(motorPin3_A, INPUT);
-    */
 
     Serial.begin(9600); // Starts the serial communication
 }

}


void SetMotor(int pinSpeed, int pin1, int pin2, int speed)
{
    analogWrite(pinSpeed, abs(speed));
    if (speed < 0)
    {
        analogWrite(pin1, 0);

const uint8_t trigPin = 9;
const uint8_t echoPin = 10;

const uint8_t ledPin = 11;

const uint8_t motorPin1_1 = 4;
const uint8_t motorPin1_2 = 5;

const uint8_t motorPin2_1 = 7;
const uint8_t motorPin2_2 = 8;


const uint8_t motorEnablePin = 3;

const uint8_t rangeLimit = 15;

