helhoaihf
This commit is contained in:
parent
af3ac3ce06
commit
932a6befc6
1 changed files with 13 additions and 0 deletions
|
@ -52,6 +52,19 @@ public class Werobot_FTC2024_carlike extends LinearOpMode {
|
||||||
imu = hardwareMap.get(BNO055IMU.class, "imu");
|
imu = hardwareMap.get(BNO055IMU.class, "imu");
|
||||||
imu.initialize(parameters);
|
imu.initialize(parameters);
|
||||||
rm.setDirection(DcMotorSimple.Direction.REVERSE);
|
rm.setDirection(DcMotorSimple.Direction.REVERSE);
|
||||||
|
telemetry.addData("Mode", "calibrating...");
|
||||||
|
telemetry.update();
|
||||||
|
|
||||||
|
// make sure the imu gyro is calibrated before continuing.
|
||||||
|
while (!isStopRequested() && !imu.isGyroCalibrated())
|
||||||
|
{
|
||||||
|
sleep(50);
|
||||||
|
idle();
|
||||||
|
}
|
||||||
|
|
||||||
|
telemetry.addData("Mode", "waiting for start");
|
||||||
|
telemetry.addData("imu calib status", imu.getCalibrationStatus().toString());
|
||||||
|
telemetry.update();
|
||||||
waitForStart();
|
waitForStart();
|
||||||
|
|
||||||
|
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue