Optical Sensor Code
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...