VisionTest.java

package workspace;

import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.util.ElapsedTime;

@Autonomous(name="Vision Test", group="Linear OpMode")

public class VisionTest extends VuforiaOp{
 @Override
 public void runOpMode(){
 ElapsedTime runtime = new ElapsedTime();
 initVision(hardwareMap);
 initialize(hardwareMap, telemetry);
 activateVision();
 telemetry.addData("Status", "waiting");
 waitForStart();
 runtime.reset();
 while(opModeIsActive()){
 calcOffset();
 if(raw_offset == null){
 telemetry.addData("Reading", "(%.2f S) null", runtime.seconds());
 strafeLeftSpd(0.1);
 }
 else{
 telemetry.addData("Reading", "(%.2f S) x: %.0f, y: %.0f, z: %.0f", runtime.seconds(), red_off, blue_off, green_off);
 strafeRightSpd(red_off/1000);
 }
 telemetry.update();
 }
 }
}