-
Notifications
You must be signed in to change notification settings - Fork 0
/
TestMap.java
61 lines (39 loc) · 1.61 KB
/
TestMap.java
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
package org.firstinspires.ftc.teamcode.Stuff_From_Loveland;
import com.qualcomm.hardware.bosch.BNO055IMU;
import com.qualcomm.hardware.bosch.JustLoggingAccelerationIntegrator;
import com.qualcomm.robotcore.hardware.AnalogInput;
import com.qualcomm.robotcore.hardware.HardwareMap;
import com.qualcomm.robotcore.util.ElapsedTime;
import org.firstinspires.ftc.robotcore.external.navigation.RelicRecoveryVuMark;
import org.firstinspires.ftc.robotcore.external.navigation.VuforiaLocalizer;
/**
* Created by Sushruth on 9/1/17.
*/
public class TestMap {
public BNO055IMU imu;
HardwareMap hwMap = null;
ElapsedTime runtime = new ElapsedTime();
AnalogInput ultrasonicLeft = null;
double tX;
double tY;
double tZ;
double rX;
double rY;
double rZ;
RelicRecoveryVuMark vuMark;
VuforiaLocalizer vuforia;
public void init(HardwareMap ahwMap) {
// save reference to HW Map
hwMap = ahwMap;
imu = hwMap.get(BNO055IMU.class, "imu");
BNO055IMU.Parameters parameters = new BNO055IMU.Parameters();
parameters.angleUnit = BNO055IMU.AngleUnit.DEGREES;
parameters.accelUnit = BNO055IMU.AccelUnit.METERS_PERSEC_PERSEC;
parameters.calibrationDataFile = "BNO055IMUCalibration.json"; // see the calibration sample opmode
parameters.loggingEnabled = true;
parameters.loggingTag = "IMU";
parameters.accelerationIntegrationAlgorithm = new JustLoggingAccelerationIntegrator();
imu.initialize(parameters);
ultrasonicLeft = hwMap.get(AnalogInput.class,"ultrasonic");
}
}