Robot sumo help!!

Other Hardware Robotics
1

i'm using arduino mega for my robot
the component that i have use is:

  1. utrasonic sensor x1 (front)
  2. IR sensor(cx-422) x2 (for sides of the robot)
  3. tcrt5000 IR sensor x4 (for detect line
  4. DC geared Motor x2
  5. motor driver fd04a x1 (for control 2 motor)

can someone help to do a program?
thanks a lots!!

2

can someone help to do a program?

To do what?

3

int FsensorPin;
int SsensorPin;
int BsensorPin;
int BssenorPin;
int LsensorPin = 22;
int RsensorPin = 24;
int trigPin = 36;
int echoPin = 38;
int LM_1 = 37; //forward left motor
int LM_2 = 39; //reverse left motor
int RM_1 = 41; //forward right motor
int RM_2 = 43; //reverse right motor

void setup() {
// put your setup code here, to run once:
Serial.begin (9600);
pinMode(LM_1, OUTPUT);
pinMode(LM_2, OUTPUT);
pinMode(RM_1, OUTPUT);
pinMode(RM_2, OUTPUT);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(LsensorPin, INPUT);
pinMode(RsensorPin, INPUT);
pinMode(FsensorPin, INPUT);
pinMode(SsensorPin, INPUT);
pinMode(BsensorPin, INPUT);
pinMode(BssensorPin, INPUT);
}

void moveStop()
{
digitalWrite(LM_1, LOW);
digitalWrite(LM_2, LOW);
digitalWrite(RM_1, LOW);
digitalWrite(RM_2, LOW);
}

void moveForward()
{
digitalWrite(LM_1, LOW);
analogWrite(LM_2, HIGH);
analogWrite(RM_1, HIGH);
digitalWrite(RM_2, LOW);
delay(300);
}

void turnLeft()
{
digitalWrite(LM_1, LOW);
digitalWrite(LM_2, HIGH);
digitalWrite(RM_1, LOW);
digitalWrite(RM_2, HIGH);
delay(300);
}

void turnRight()
{
digitalWrite(LM_1, HIGH);
digitalWrite(LM_2, LOW);
digitalWrite(RM_1, HIGH);
digitalWrite(RM_2, LOW);
delay(300);
}

void moveBack()
{
digitalWrite(LM_1, HIGH);
digitalWrite(LM_2, LOW);
digitalWrite(RM_1, LOW);
digitalWrite(RM_2, HIGH);
delay(500);
}

void loop ()
{
long duration, distance;
digitalWrite(trigPin, LOW); // Added this line
delayMicroseconds(2); // Added this line
digitalWrite(trigPin, HIGH);
// delayMicroseconds(1000); - Removed this line
delayMicroseconds(10); // Added this line
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = (duration/2) / 29.1;
if (distance < 7 ) ;{
moveForward();
}
else

FsensorPin = analogRead(A0);
if (FsensorPin <= 100){
moveBack();
moveLeft();
}
else

SsensorPin = analogRead(A1);
if (SsensorPin <= 100) {
moveBack();
moveRight();
}
else
BsensorPin = analogRead(A2);
if (BsensorPin <= 100){
moveForward();
moveLeft();
}
else
BssensorPin = analogRead(A3);
if (BssensorPin <= 100) {
moveForward();
moveRigt();
}
if (digitalWrite(LsensorPin = high)) {
moveLeft();
moveForward();
}
else if (digitalWrite(RsensorPin = high)) {
moveRight();
moveForward();
}
}

4

int FsensorPin;
int SsensorPin;
int BsensorPin;
int BssenorPin;

is IR sensor detect white line...
can help me to correct it?

5 
int FsensorPin;
int SsensorPin;
int BsensorPin;
int BssenorPin;

You have 4 variables with the same value (0). Do you really expect to read data for different sensors using one pin?

if (distance < 7 ) ;{
 moveForward();
}
 else

FsensorPin = analogRead(A0);

Does that even compile? If you have a book with an example of an if statement ending with a ;, toss the book in the trash.

if (digitalWrite(LsensorPin = high)) {

Rubbish, pure and simple. It is pointless to assign a value to a variable using an if statement. The digitalWrite() method does not return a value that can be compared to anything.
You should ALWAYS use curly braces for if, else, for, while, etc. statements. They aren't really optional until you KNOW what you are doing.

6

thanks for your comment~i'm just a beginner,i don't have any arduino books.Now i know my misstake already,i try to do the correction.