made more lines up but will need to test them and will introduce Bluetooth as well not sure if I want joystick or a standard remote
int MAINDCLEFT_IN1 = 3;
int MAINDCLEFT_IN2 = 2;
int MAINDCRIGHT_IN3 = 1;
int MAINDCRIGHT_IN4 = 0;
int MAINDCLEFT_ENA = 9;
int MAINDCRIGHT_ENB = 11;
int ARMLEFT_IN1 = 4;
int ARMLEFT_IN2 = 5;
int ARMRIGHT_IN3 = 6;
int ARMRIGHT_IN4 = 7;
//int ARMLEFT_ENA = ;
//int ARMRIGHT_ENB = ;
int A360_IN1 = 8;
//int A360_IN2 = 9;
int GRABBER_IN3 = 10;
//int GRABBER_IN4 = 11;
//int A360_ENA = ;
//int GRABBER_ENB = ;
void setup() {
// Initialize Serial
//this starts the communication between my PC to my Arduino
Serial.begin(9600);
Serial.println("HELLO_my_name_is_OCO_ONE");
// Set all the motor control pins to outputs
pinMode(MAINDCLEFT_IN1, OUTPUT);
pinMode(MAINDCLEFT_IN2, OUTPUT);
pinMode(MAINDCRIGHT_IN3, OUTPUT);
pinMode(MAINDCRIGHT_IN4, OUTPUT);
pinMode(MAINDCLEFT_ENA, OUTPUT);
pinMode(MAINDCRIGHT_ENB, OUTPUT);
STOP_ALL();
Serial.println("SETUP FINISHED");
}
void STOP_ALL()
{
// Turn off motors - Initial state
digitalWrite(MAINDCLEFT_IN1, LOW);
digitalWrite(MAINDCLEFT_IN2, LOW);
digitalWrite(MAINDCRIGHT_IN3, LOW);
digitalWrite(MAINDCRIGHT_IN4, LOW);
Serial.println("WHAT IS GOING ON ");
analogWrite(MAINDCLEFT_ENA, 0);
analogWrite(MAINDCRIGHT_ENB, 0);
}
void FORWARD()
{
// Turn on Main DC Motors Clockwise
analogWrite(MAINDCLEFT_ENA, 155);
analogWrite(MAINDCRIGHT_ENB, 155);
digitalWrite(MAINDCLEFT_IN1, HIGH);
digitalWrite(MAINDCLEFT_IN2, LOW);
digitalWrite(MAINDCRIGHT_IN3, HIGH);
digitalWrite(MAINDCRIGHT_IN4, LOW);
Serial.println("MOTORS Moving Forward ");
}
//void BACKWARD()
//{
// Turn on Main DC Motors Anticlockwise
// analogWrite(MAINDCLEFT_ENA, 155);
// analogWrite(MAINDCRIGHT_ENB, 155);
// digitalWrite(MAINDCLEFT_IN1, LOW);
// digitalWrite(MAINDCLEFT_IN2, HIGH);
// digitalWrite(MAINDCRIGHT_IN3, LOW);
// digitalWrite(MAINDCRIGHT_IN4, HIGH);
//Serial.println("MOTORS Moving Backwards ");
//}
//void LEFT()
//{
// Turn on Main DC Motors left
// analogWrite(MAINDCLEFT_ENA, 155);
// analogWrite(MAINDCRIGHT_ENB, 155);
// digitalWrite(MAINDCLEFT_IN1, LOW);
// digitalWrite(MAINDCLEFT_IN2, HIGH);
// digitalWrite(MAINDCRIGHT_IN3, LOW);
// digitalWrite(MAINDCRIGHT_IN4, HIGH);
//Serial.println("MOTORS Moving Left ");
//}
//void RIGHT()
//{
// Turn on Main DC Motors Right
// analogWrite(MAINDCLEFT_ENA, 155);
// analogWrite(MAINDCRIGHT_ENB, 155);
// digitalWrite(MAINDCLEFT_IN1, LOW);
// digitalWrite(MAINDCLEFT_IN2, HIGH);
// digitalWrite(MAINDCRIGHT_IN3, LOW);
// digitalWrite(MAINDCRIGHT_IN4, HIGH);
//Serial.println("MOTORS Moving Right ");
//}
//void ARMLEFT_FORWARD()
//{
// ARM LEFT MOVING FORWARD
// analogWrite(ARMLEFT_ENA, 155);
// digitalWrite(ARMLEFT_IN1, LOW);
// digitalWrite(ARMLEFT_IN2, HIGH);
//Serial.println("ARM LEFT MOVING FORWARD");
//}
//void ARMLEFT_BACKWARD()
//{
// ARM LEFT MOVING BACKWARD
// analogWrite(ARMLEFT_ENA, 155);
// digitalWrite(ARMLEFT_IN1, LOW);
// digitalWrite(ARMLEFT_IN2, HIGH);
//Serial.println("ARM LEFT MOVING BACKWARD");
//}
//void ARMRIGHT_FORWARD()
//{
// ARM RIGHT MOVING FORWARD
// analogWrite(ARMRIGHT_ENB, 155);
// digitalWrite(ARMRIGHT_IN3, LOW);
// digitalWrite(ARMRIGHT_IN4, HIGH);
//Serial.println("ARM RIGHT MOVING FORWARD");
//}
//void ARMRIGHT_BACKWARD()
//{
// ARM RIGHT MOVING BACKWARD
// analogWrite(ARMRIGHT_ENB, 155);
// digitalWrite(ARMRIGHT_IN3, LOW);
// digitalWrite(ARMRIGHT_IN4, HIGH);
//Serial.println("ARM RIGHT MOVING BACKWARD ");
//}
//void A360_CLOCKWISE()
//{
// TURN ARM 360 CLOCKWISE
// analogWrite(A360_ENB, 155);
// digitalWrite(A360_IN3, LOW);
// digitalWrite(A360_IN4, HIGH);
//Serial.println("TURN ARM 360 CLOCKWISE ");
//}
//void A360_ANTI_CLOCKWISE()
//{
// TURN ARM 360 ANTICLOCKWISE
// analogWrite(A360_ENB, 155);
// digitalWrite(A360_IN3, LOW);
// digitalWrite(A360_IN4, HIGH);
//Serial.println("TURN ARM 360 ANTICLOCKWISE ");
//}
//void GRABBER_OPEN()
//{
// OPEN GRABBER
// analogWrite(A360_ENB, 155);
// digitalWrite(A360_IN3, LOW);
// digitalWrite(A360_IN4, HIGH);
//Serial.println("GRABBER OPEN ");
//}
//void GRABBER_CLOSE()
//{
// CLOSE GRABBER
// analogWrite(A360_ENB, 155);
// digitalWrite(A360_IN3, LOW);
// digitalWrite(A360_IN4, HIGH);
//Serial.println("GRABBER CLOSE ");
//}
void loop() {
FORWARD();
Serial.println("STARTING 3SEC DELAY ");
delay(3000);
STOP_ALL();
}