Adjust Pose Orientation

Description

This operator is used to adjust the orientation of the input pose list to meet specific directional constraints. For example, adjusting the tool so its Z-axis points up or down, or aligning the tool’s X-axis to a specific direction.

Overview

Adjusts the orientation of a specified axis to align with a specific direction or restrict it to positive/negative directions.

Scenarios

  • Standardize Grasp Pose: In robot grasping applications, even if the object has multiple possible grasp poses, it is often necessary to restrict the final tool orientation to a few or a single standard direction to simplify robot motion planning or avoid collisions. For example, requiring the tool’s Z-axis (usually the axis approaching the object) to point vertically downward regardless of how the object is placed.

  • Eliminate Rotation Ambiguity: Some pose estimation algorithms might produce ambiguity of 180-degree rotation around an axis. This operator can correct the pose based on prior knowledge (e.g., which face of the object should face up).

  • Align to Specific Direction: Need to align a specific axis of the tool to a specific direction vector in the scene (e.g., along the direction of a conveyor belt).

Inputs and Outputs

Inputs

Target Object Pose Information: The input pose list.

Outputs

Target Object Pose Information: The pose list after orientation adjustment.

Parameters

Adjustment strategy

Description

Selects which main orientation adjustment method to apply; different strategies correspond to different subsequent parameters.

Tuning Instructions

  • Adjust the orientation according to the specified X/Y/Z direction (Default): Actively adjusts a specific axis (Main directional axis) of the pose to point roughly towards the positive or negative direction of the corresponding axis in the world coordinate system, and allows further optimization of the orientation of a second axis (Secondary directional axis) to better meet actual application needs.

  • Align specified axis to specified direction: Precisely aligns a specific axis (Specify direction axis) of the pose to any user-provided direction vector, and can constrain another axis (Fixed directional axis) to point towards a specific positive or negative direction as much as possible under the aligned pose.

Parameter Range

Values/Range:

  • Align Specified Axis to Specified Direction

  • Restrict Specified Axis to Positive/Negative Direction

Default: Restrict Specified Axis to Positive/Negative Direction

Main Directional Axis

Description

"Select the main axis (X, Y, or Z) of the pose coordinate system to adjust orientation. (Effective when 'Adjustment strategy' is set to 'Adjust the orientation according to the specified X/Y/Z direction')"

Tuning Instructions

Usually select the axis corresponding to the key direction of the robot tool, such as the tool’s approach direction (often the Z-axis).

Parameter Range

Values/Range:

  • X

  • Y

  • Z

Default: Z

Secondary directional axis

Description

After the Main directional axis adjustment is completed, select the secondary axis (X, Y, or Z) of the pose coordinate system that needs further orientation optimization. Ensure the selected secondary axis is different from the Main directional axis. (Effective when 'Adjustment strategy' is set to 'Adjust the orientation according to the specified X/Y/Z direction')

Tuning Instructions

Used to eliminate rotational degrees of freedom around the Main directional axis. For example, if the main axis is Z, the X axis can be selected as the secondary axis.

Parameter Range

Values/Range:

  • X

  • Y

  • Z

Default: X

Specified direction of main axis

Description

Specifies which direction of the corresponding axis in the world coordinate system the "Main directional axis" selected above should point to. (Effective when 'Adjustment strategy' is set to 'Adjust the orientation according to the specified X/Y/Z direction')

Tuning Instructions

  • Positive direction (Default): For example, if the Main directional axis is Z, it will adjust the pose’s Z-axis to align with the +Z direction of the world coordinate system.

  • Negative direction: For example, if the Main directional axis is Z, it will adjust the pose’s Z-axis to align with the -Z direction of the world coordinate system.

The operator checks the angle between the current pose’s main axis direction and the target direction; if the angle is Greater than or equal to 90 degrees, a 180-degree rotation adjustment is performed.

Parameter Range

Values/Range:

  • Positive Direction

  • Negative Direction

Default: Positive Direction

Specified direction of secondary axis

Description

Specifies the target direction of the corresponding axis in the world coordinate system that the "Secondary directional axis" selected above should try to align with after the main axis adjustment is completed. (Effective when 'Adjustment strategy' is set to 'Adjust the orientation according to the specified X/Y/Z direction')

Tuning Instructions

  • Positive direction (Default) / Negative direction: Similar to the main axis, the operator checks the angle between the current secondary axis direction and the target direction; if the angle is greater than 90 degrees, it rotates 180 degrees around the main axis for adjustment.

  • Keep original direction: Do not make extra adjustments to the secondary axis direction, maintaining its relative orientation after the main axis adjustment.

Parameter Range

Values/Range:

  • Positive Direction

  • Negative Direction

  • Keep Original Direction

Default: Positive Direction

Specify direction axis

Description

Selects which axis (X, Y, or Z) of the pose coordinate system needs to be precisely aligned to the target direction. (Effective when 'Adjustment strategy' is set to 'Align specified axis to specified direction')

Tuning Instructions

Select the tool axis that needs alignment, such as the tool’s Z-axis.

Parameter Range

Values/Range:

  • X

  • Y

  • Z

Default: Z

Selected axis specified direction

Description

Provides a 3D vector defining the target direction that the "Specify direction axis" needs to align with. (Effective when 'Adjustment strategy' is set to 'Align specified axis to specified direction')

Tuning Instructions

Input a vector representing the direction, for example, [0, 0, 1] means aligning to the positive Z direction of the world coordinate system, [1, 0, 0] means aligning to the positive X direction, or any direction like [1, 1, 0] (the operator will normalize it internally).

Parameter Range

Default: [0, 0, 1]

Fixed directional axis

Description

After "Specify direction axis" alignment is complete, select another axis (X, Y, or Z) of the pose coordinate system as a reference to eliminate rotation around the aligned axis. Note that it must be different from the Specify direction axis. (Effective when 'Adjustment strategy' is set to 'Align specified axis to specified direction')

Tuning Instructions

Select an axis that requires further directional constraint after alignment.

Parameter Range

Values/Range:

  • X

  • Y

  • Z

Default: X

Specified direction of fixed axis

Description

Specifies which direction of the corresponding axis in the world coordinate system the "Fixed directional axis" selected above should try to point to after main axis alignment. (Effective when 'Adjustment strategy' is set to 'Align specified axis to specified direction')

Tuning Instructions

  • Positive direction (Default) / Negative direction: The operator checks the angle between the Fixed directional axis and the corresponding world axis (determined by the world axis the fixed axis points to; e.g., if the fixed axis is X, it compares it with the world X, Y, or Z axis it is closest to). If necessary (angle > 90 degrees), it rotates 180 degrees around the aligned "Specify direction axis".

  • Not specified: Do not apply extra constraints to the fixed axis.

Parameter Range

Values/Range:

  • Positive Direction

  • Negative Direction

  • Not Specified

Default: Positive Direction

Enable Node

Description

Controls whether this operator performs orientation restriction operations.

Tuning Instructions

  • If the switch is On, the operator executes the function normally;

  • If the switch is Off, the operator does not perform any operation and passes the input pose list directly to the output port.

Parameter Range

Default: True