本文整理汇总了Java中org.firstinspires.ftc.robotcore.external.navigation.Orientation.getOrientation方法的典型用法代码示例。如果您正苦于以下问题:Java Orientation.getOrientation方法的具体用法?Java Orientation.getOrientation怎么用?Java Orientation.getOrientation使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类org.firstinspires.ftc.robotcore.external.navigation.Orientation
的用法示例。
在下文中一共展示了Orientation.getOrientation方法的7个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Java代码示例。
示例1: getVuMarkOrientation
import org.firstinspires.ftc.robotcore.external.navigation.Orientation; //导入方法依赖的package包/类
public Orientation getVuMarkOrientation()
{
Orientation targetAngle = null;
VuforiaTrackable target = vuforia.getTarget(0);
RelicRecoveryVuMark vuMark = RelicRecoveryVuMark.from(target);
if (vuforia.isTargetVisible(target) && vuMark != RelicRecoveryVuMark.UNKNOWN)
{
OpenGLMatrix pose = vuforia.getTargetPose(target);
if (pose != null)
{
targetAngle = Orientation.getOrientation(
pose, AxesReference.EXTRINSIC, AxesOrder.XYZ, AngleUnit.DEGREES);
robot.tracer.traceInfo("TargetRot", "%s: xRot=%6.2f, yRot=%6.2f, zRot=%6.2f",
vuMark.toString(),
targetAngle.firstAngle, targetAngle.secondAngle, targetAngle.thirdAngle);
}
}
return targetAngle;
}
示例2: updateLocation
import org.firstinspires.ftc.robotcore.external.navigation.Orientation; //导入方法依赖的package包/类
public void updateLocation(){
OpenGLMatrix pose = ((VuforiaTrackableDefaultListener)relicVuMark.getListener()).getPose();
telemetry.addData("Pose", format(pose));
/* We further illustrate how to decompose the pose into useful rotational and
* translational components */
if (pose != null) {
VectorF trans = pose.getTranslation();
Orientation rot = Orientation.getOrientation(pose, AxesReference.EXTRINSIC, AxesOrder.XYZ, AngleUnit.DEGREES);
// Extract the X, Y, and Z components of the offset of the target relative to the robot
tX = trans.get(0);
tY = trans.get(1);
tZ = trans.get(2);
// Extract the rotational components of the target relative to the robot
rX = rot.firstAngle;
rY = rot.secondAngle;
rZ = rot.thirdAngle;
//Z is forward-backward
//x is sideways
}
}
示例3: getVuMarkOrientation
import org.firstinspires.ftc.robotcore.external.navigation.Orientation; //导入方法依赖的package包/类
private Orientation getVuMarkOrientation()
{
Orientation targetAngle = null;
VuforiaTrackable target = vuforia.getTarget(0);
RelicRecoveryVuMark vuMark = RelicRecoveryVuMark.from(target);
if (vuforia.isTargetVisible(target) && vuMark != RelicRecoveryVuMark.UNKNOWN)
{
OpenGLMatrix pose = vuforia.getTargetPose(target);
if (pose != null)
{
targetAngle = Orientation.getOrientation(
pose, AxesReference.EXTRINSIC, AxesOrder.XYZ, AngleUnit.DEGREES);
}
}
return targetAngle;
}
示例4: runOpMode
import org.firstinspires.ftc.robotcore.external.navigation.Orientation; //导入方法依赖的package包/类
public void runOpMode() throws InterruptedException
{
setupVuforia();
lastKnownLocation = createMatrix(0,0,0,0,0,0);
waitForStart();
visionTargets.activate();
while(opModeIsActive())
{
OpenGLMatrix latestLocation = listener.getUpdatedRobotLocation();
vuMark = RelicRecoveryVuMark.from(relicVuMark);
if(latestLocation !=null)
{lastKnownLocation = latestLocation;}
float[] coordinates = lastKnownLocation.getTranslation().getData();
robotX = coordinates[0];
robotY = coordinates[1];
robotAngle = Orientation.getOrientation(lastKnownLocation, AxesReference.EXTRINSIC, AxesOrder.XYZ, AngleUnit.DEGREES).thirdAngle;
RelicRecoveryVuMark key = vuMark;
if (vuMark != RelicRecoveryVuMark.UNKNOWN) {
telemetry.addData("Navi", "%s visible", vuMark);
}else{
telemetry.addData("Navi", "not visible");
telemetry.addData("Navi Sees:", vuMark);
}
telemetry.addData("Last Known Location", formatMatrix(lastKnownLocation));
telemetry.addData("key",key.toString());
telemetry.update();
}
}
示例5: runOpMode
import org.firstinspires.ftc.robotcore.external.navigation.Orientation; //导入方法依赖的package包/类
public void runOpMode() throws InterruptedException
{
setupVuforia();
lastKnownLocation = createMatrix(0,0,0,0,0,0);
waitForStart();
visionTargets.activate();
while(opModeIsActive())
{
OpenGLMatrix latestLocation = listener.getUpdatedRobotLocation();
vuMark = RelicRecoveryVuMark.from(relicVuMark);
if(latestLocation !=null)
{lastKnownLocation = latestLocation;}
float[] coordinates = lastKnownLocation.getTranslation().getData();
robotX = coordinates[0];
robotY = coordinates[1];
robotAngle = Orientation.getOrientation(lastKnownLocation, AxesReference.EXTRINSIC, AxesOrder.XYZ, AngleUnit.DEGREES).thirdAngle;
if (vuMark != RelicRecoveryVuMark.UNKNOWN) {
key = vuMark;
}
}
}
示例6: loop
import org.firstinspires.ftc.robotcore.external.navigation.Orientation; //导入方法依赖的package包/类
@Override
public void loop(){
OpenGLMatrix latestLocation = listener.getUpdatedRobotLocation();
vuMark = RelicRecoveryVuMark.from(relicVuMark);
if(latestLocation !=null) {lastKnownLocation = latestLocation;}
float[] coordinates = lastKnownLocation.getTranslation().getData();
robotX = coordinates[0];
robotY = coordinates[1];
robotAngle = Orientation.getOrientation(lastKnownLocation, AxesReference.EXTRINSIC, AxesOrder.XYZ, AngleUnit.DEGREES).thirdAngle;
if (vuMark != RelicRecoveryVuMark.UNKNOWN) {
key = vuMark;
}
double x = gamepad1.right_stick_x;
double y = gamepad1.right_stick_y;
double c = gamepad1.left_trigger-gamepad1.right_trigger;
motor1.setPower(Range.clip(y-x+c, -1, 1));
motor2.setPower(Range.clip(y+x-c, -1, 1));
motor3.setPower(Range.clip(y+x+c, -1, 1));
motor4.setPower(Range.clip(y-x-c, -1, 1));
if (gamepad2.right_trigger > 0) {
leftcr.setPower(1);
rightcr.setPower(1);
}else if(gamepad2.left_trigger > 0) {
leftcr.setPower(-1);
rightcr.setPower(-1);
}else {
leftcr.setPower(0.1);
rightcr.setPower(0);
}
if(gamepad2.x) {
glyph.setPosition(1);
}
else if(gamepad2.a) {
glyph.setPosition(0);
}
else if(gamepad2.b) {
glyph.setPosition(-1);
}
telemetry.addData("motor 1 pos", motor1.getCurrentPosition());
telemetry.addData("motor 2 pos", motor2.getCurrentPosition());
telemetry.addData("motor 3 pos", motor3.getCurrentPosition());
telemetry.addData("motor 4 pos", motor4.getCurrentPosition());
telemetry.addData("jewel servo pos", jewelcr.getPower());
updateLocation();
telemetry.addData("Last Known Location", formatMatrix(lastKnownLocation));
telemetry.addData("Red",color1.red());
telemetry.addData("Blue",color1.blue());
telemetry.update();
}
示例7: updateLocation
import org.firstinspires.ftc.robotcore.external.navigation.Orientation; //导入方法依赖的package包/类
public void updateLocation(){
OpenGLMatrix pose = ((VuforiaTrackableDefaultListener)relicVuMark.getListener()).getPose();
telemetry.addData("Pose", format(pose));
/* We further illustrate how to decompose the pose into useful rotational and
* translational components */
if (pose != null) {
VectorF trans = pose.getTranslation();
Orientation rot = Orientation.getOrientation(pose, AxesReference.EXTRINSIC, AxesOrder.XYZ, AngleUnit.DEGREES);
// Extract the X, Y, and Z components of the offset of the target relative to the robot
tX = trans.get(0);
tY = trans.get(1);
tZ = trans.get(2);
// Extract the rotational components of the target relative to the robot
rX = rot.firstAngle;
rY = rot.secondAngle;
rZ = rot.thirdAngle;
// Z is forward-backward
//x is sideways
}
}