View unanswered posts | View active topics It is currently Tue Aug 21, 2018 11:31 pm






Reply to topic  [ 1 post ] 
i have a problem with my robot 
Author Message
Rookie

Joined: Sun May 29, 2016 8:51 am
Posts: 1
Post i have a problem with my robot
Image



Image

that's my robot
and i wrote code and he is somtaym Sometimes works and Sometimes have problems
and i dont know why

this is the code

Code:
#pragma config(Sensor, S2,     colour,         sensorEV3_Color)
#pragma config(Motor,  motorB,          leftwheel,     tmotorEV3_Large, PIDControl, encoder)
#pragma config(Motor,  motorC,          rightwheel,    tmotorEV3_Large, PIDControl, encoder)
#pragma config(Motor,  motorD,          arm,              tmotorEV3_Large, PIDControl, encoder)


bool mone = true;
bool colorBlacks = true;

void unpackege()
{
   if(mone)
      {
         mone = false;
       motor[leftwheel] = 0;
       motor[rightwheel] = 0;
         setMotorReversed(leftwheel, true);
         setMotorReversed(rightwheel, true);
      sleep(500);
      setMotorTarget(leftwheel, 2500, 20);
          setMotorTarget(rightwheel, 2500, 20);
      sleep(2500);
      if (colorBlacks)
         {
            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorReversed(leftwheel, true);
            setMotorReversed(rightwheel, false);
            sleep(1500);
            setMotorTarget(leftwheel, 150, 10);
            setMotorTarget(rightwheel, 150, 10);
            sleep(750);

            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorReversed(leftwheel, false);
               setMotorReversed(rightwheel, false);
            sleep(500);
            setMotorTarget(leftwheel, 200, 25);
                setMotorTarget(rightwheel, 200, 25);
                sleep(500);
            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);

            setMotorReversed(arm, false);
            sleep(500);
            setMotorTarget(arm, 0, 50);
            sleep(1000);

            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorReversed(leftwheel, true);
               setMotorReversed(rightwheel, true);
            sleep(500);
            setMotorTarget(leftwheel, 200, 25);
                setMotorTarget(rightwheel, 200, 25);
                sleep(500);
            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);

            setMotorReversed(leftwheel, false);
            setMotorReversed(rightwheel, true);
            sleep(250);
            setMotorTarget(leftwheel, 150, 10);
            setMotorTarget(rightwheel, 150, 10);
            sleep(750);
            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            }



            if (!colorBlacks)
            {
               motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorReversed(leftwheel, false);
            setMotorReversed(rightwheel, true);
            sleep(500);
            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorTarget(leftwheel, 150, 10);
            setMotorTarget(rightwheel, 150, 10);
            sleep(750);

            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorReversed(leftwheel, false);
               setMotorReversed(rightwheel, false);
            sleep(500);
            setMotorTarget(leftwheel, 200, 25);
                setMotorTarget(rightwheel, 200, 25);
                sleep(500);
            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);

            setMotorReversed(arm, false);
            sleep(500);
            setMotorTarget(arm, 0, 50);
            sleep(1000);

            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorReversed(leftwheel, true);
               setMotorReversed(rightwheel, true);
            sleep(500);
            setMotorTarget(leftwheel, 200, 25);
                setMotorTarget(rightwheel, 200, 25);
                sleep(500);
            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorReversed(leftwheel, true);
            setMotorReversed(rightwheel, false);
            sleep(250);
            motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
            setMotorTarget(leftwheel, 150, 10);
            setMotorTarget(rightwheel, 150, 10);
            sleep(750);
           motor[leftwheel] = 0;
            motor[rightwheel] = 0;
            sleep(250);
         }
    }
}
void checkBoxes()
{
   int colorsencore = 0;
   int lowest = 50;
   int highest = 0;


   if (SensorValue[colour] > highest)
    {
      highest = SensorValue[colour];
    }
  colorsencore = highest;

   if(colorsencore > 22)
    {
       motor[leftwheel] = 0;
         motor[rightwheel] = 0;
         sleep(750);
         highest = SensorValue[colour];
      colorsencore = highest;
      sleep(750);
    if(colorsencore > 40)
    {
       colorBlacks = false;
       displayCenteredBigTextLine(4, "white");
    }
    if(colorsencore < 40)
    {
       colorBlacks = true;
       displayCenteredBigTextLine(4, "purple");
    }

         sleep(1000);

         if(mone)
         {
            setMotorReversed(arm, true);
            sleep(500);
            setMotorTarget(arm, 800, 100);
            sleep(1000);
            unpackege();
            sleep(1000);
            setMotorReversed(arm, false);
            sleep(500);
            setMotorTarget(arm, 0, 50);
            sleep(1000);
            }
               colorsencore =0;
      }
}

void StartRobot()
{
   if (!mone)
      {
         mone = true;
         motor[leftwheel] = 0;
         motor[rightwheel] = 0;
         setMotorReversed(leftwheel, false);
          setMotorReversed(rightwheel, false);
      }
   motor[leftwheel] = 25;
  motor[rightwheel] = 25;
   checkBoxes();
}

task main()
{
       //motor[arm] = 0;
    //motor[arm] = -10;
     //setMotorReversed(arm, true);
      //setMotorTarget(arm, 800, 100);
     //setMotorReversed(arm, false);
     //setMotorTarget(arm, 800, 100);

   displayCenteredBigTextLine(4, "none");
  checkBoxes();
  while (true)
  {
     StartRobot();
  }
}



Sun May 29, 2016 8:59 am
Profile
Display posts from previous:  Sort by  
Reply to topic   [ 1 post ] 

Who is online

Users browsing this forum: No registered users and 1 guest


You cannot post new topics in this forum
You cannot reply to topics in this forum
You cannot edit your posts in this forum
You cannot delete your posts in this forum
You cannot post attachments in this forum

Search for:
Jump to:  



Powered by phpBB © 2000, 2002, 2005, 2007 phpBB Group.
Designed by ST Software for PTF.