Optical Sensor Code

 avatar
unknown
c_cpp
4 years ago
2.2 kB
6
Indexable
/*----------------------------------------------------------------------------*/
/*                                                                            */
/*    Module:       main.cpp                                                  */
/*    Author:       C:\Users\vangi                                            */
/*    Created:      Wed Nov 10 2021                                           */
/*    Description:  V5 project                                                */
/*                                                                            */
/*----------------------------------------------------------------------------*/

// ---- START VEXCODE CONFIGURED DEVICES ----
// Robot Configuration:
// [Name]               [Type]        [Port(s)]
// M                    motor         10              
// O                    optical       1               
// ---- END VEXCODE CONFIGURED DEVICES ----

#include "vex.h"

using namespace vex;

void clearReset() {
  
  Brain.Screen.clearScreen();
  Brain.Screen.setCursor(1,1);
  Brain.Screen.setFont(monoM);
}

int main() {
  // Initializing Robot Configuration. DO NOT REMOVE!
  vexcodeInit();

  Brain.Screen.print("Press the screen to start inspection");

  while(!Brain.Screen.pressing()) {

    wait(0.05,seconds);
    
  }

  clearReset();

  Brain.Screen.print("Inspecting...");
  Brain.Screen.newLine();

  O.setLight(ledState::on);

  M.spin(forward,10,percent);

  while(true) {

    if(O.isNearObject()) {

      if(O.color() == blue) {

        M.spin(forward,0 ,percent);

        Brain.Screen.print("BLUE Detected");
        Brain.Screen.newLine();

        wait(1.5,seconds);

        M.spin(forward,10,percent);

      } else if (O.color() == red) {

        M.spin(forward,0 ,percent);

        Brain.Screen.print("RED Detected");
        Brain.Screen.newLine();

        wait(1.5,seconds);

        M.spin(forward,10,percent);

      } else {

        M.spin(forward,0 ,percent);

        wait(1.5,seconds);

        M.spin(forward,10,percent);

      }

      wait(0.05,seconds);

    }

  }
  
}
Editor is loading...