---
title: Safe ZYZ Regrasp Strategies
url: https://www.emergentmind.com/topics/safe-zyz-regrasp-strategies
type: topic
---

# Safe ZYZ Regrasp Strategies

Safe ZYZ regrasp strategies are regrasp planning and execution methods in which object or end-effector orientation is represented by Z–Y–Z Euler angles $(\alpha,\beta,\gamma)$ and coupled to explicit safety conditions during manipulation. In the cited work, safety is enforced through singularity-avoidance guards for $\beta \rightarrow \pm 90^\circ$, kinematic-feasibility and dynamic-feasibility checks, collision avoidance, workspace containment, grasp-torque and friction constraints, and, in a related line of work, uncertainty-robust external-contact pushing for fixtureless fixturing. Across these formulations, regrasp is not treated as a single motion primitive but as a sequence involving sliding, lifting, transfer, approach, release, or pushing under manifold, contact, and reachability constraints [2309.15283, 2508.21272, 1809.08522].

## 1. Formal problem setting

A central motivation for regrasp planning is that grasping algorithms can predict a candidate of grasp poses, even for unseen objects, yet some of the predicted grasp poses to stably lift a target object may not be directly approachable due to workspace limitations. In such cases, the robot will need to re-grasp the desired object to enable successful grasping on it. The 2023 multi-modal planner formulates this as a Markov-Decision Process in which a state is a tuple
$$
s=(q,M,o),
$$
where $q\in\mathbb{R}^n$ is the full robot configuration, $M$ is the mode or manifold index, and $o=(x,y,z,\alpha,\beta,\gamma)\in SE(3)$ is the object pose parametrized by position plus Z–Y–Z Euler angles. The planner distinguishes the foliations $F^{slide}$, $F^{transfer}$, and $F^{re\text{–}grasp}$, and it treats the current grasp-ID $g$ as implicit whenever $M\in\{\text{slide},\text{transfer}\}$ [2309.15283].

Within that formulation, every action is a parameterized primitive
$$
a=(\text{type},\text{start\_state},\text{end\_state},\text{traj}),
$$
with $\text{type}\in\{\text{Approach},\text{Release},\text{Slide},\text{Lift},\text{Transfer},\text{Regrasp}\}$. The planner therefore places regrasp in a broader multi-modal manipulation setting rather than restricting it to a single wrist reorientation or a single grasp swap. A related but execution-oriented formulation appears in the 2025 Soma-cube system, where safe ZYZ regrasp is embedded in legal-action masked DQN and in the control layer of a Doosan M0609 collaborative robot, so that orientation decisions are filtered by reachability and safety before execution [2508.21272].

A broader related context is provided by fixtureless fixturing, where regrasping is achieved by pushing the object against external contact or contacts in the environment such that the external contact keeps the object stationary while the fingers slide over the object. That line of work does not center Z–Y–Z angles, but it addresses the same core problem of safe reconfiguration of grasp state under explicit contact-mechanics constraints [1809.08522].

## 2. Z–Y–Z orientation model and singularity-safe orientation handling

In the 2025 formulation, the end-effector target orientation is represented as
$$
R(\alpha,\beta,\gamma)=R_z(\alpha)R_y(\beta)R_z(\gamma),
$$
with the standard matrix forms for $R_z(\theta)$ and $R_y(\phi)$. This provides a direct orientation parameterization for regrasp planning and for the orientation component of the hierarchical DQN, where “ori” corresponds to one of the 116 Z–Y–Z orientations [2508.21272].

The principal safety issue associated with this representation is that Z–Y–Z suffers gimbal lock when $\beta\rightarrow \pm 90^\circ$. The cited work gives two classical detection or prevention mechanisms. The first is a proximity index on $\beta$,
$$
\mathrm{PI}(\beta)=1-\lvert\cos\beta\rvert,
$$
and if $\mathrm{PI}(\beta)>0.9$, the pose is treated as near-singular. The second is Jacobian-based manipulability in the sense of Yoshikawa,
$$
\mu(q)=\sqrt{\det(J(q)J(q)^T)},
$$
with either a lower bound $\mu(q)>\mu_{\min}$ or, equivalently, an upper bound on the condition number
$$
\kappa(J)=\frac{\sigma_{\max}(J)}{\sigma_{\min}(J)}<\kappa_{\max}.
$$
In the paper, the simpler $\beta$-proximity guard is used for real-time: if $|\beta-90^\circ|<\epsilon$ or $|\beta+90^\circ|<\epsilon$, then $\beta$ is clamped to $\pm 89.9^\circ$ and regrasp logic is triggered [2508.21272].

The 2023 planner shows how Z–Y–Z variables can also be inserted directly into the MDP state and transition cost. It explicitly includes $(\alpha,\beta,\gamma)$ in $o$ and permits an orientation-variation penalty
$$
c_{orient}(a)=\lambda \,\|\Delta Euler_{ZYZ}(a)\|^2
=\lambda[(\alpha'-\alpha)^2+(\beta'-\beta)^2+(\gamma'-\gamma)^2].
$$
It also allows hard limits by discarding any action for which any $|\Delta_i|>\text{limit}_i$. In $M^{transfer}$ it enforces “vertical orientation,” i.e. $\beta\approx 0$ so the cup or object does not tilt [2309.15283].

Taken together, these formulations show that safe ZYZ regrasp is not merely a coordinate convention. The orientation representation directly enters state construction, feasibility tests, transition costs, and singularity guards. A plausible implication is that the usefulness of Z–Y–Z in regrasp planning depends less on the parametrization alone than on whether the planner and controller explicitly protect against the $\beta\approx \pm 90^\circ$ regime.

## 3. Safety conditions in multi-modal planning

The 2023 MDP-based planner makes safety an action-feasibility property before optimization. Every primitive is feasible only if kinematic-feasibility and dynamic-feasibility hold, specifically $IK(q_{start})=\text{true}$, $IK(q_{end})=\text{true}$, and for any intermediate waypoint, friction-torque and contact constraints hold. For sliding, the object is dragged on the table plane with $\Delta z=0$; for lift, the motion is a vertical pull-up with $\Delta x=\Delta y=0$ and orientation locked; and for approach or release, the motion is between a pre-grasp pose and a stable placement. These constraints define the admissible regrasp graph before value iteration is applied [2309.15283].

Contact stability is enforced by a Coulomb-friction grasp condition. The grasp is stable if
$$
\|\tau_{grav}\|=m\,g\,\|p_{COM}-p_{grasp}\|\le \mu\,F_n,
$$
and no action is added to the action set unless it satisfies this at every waypoint. The same summary introduces a torque-margin penalty
$$
c_{torque}(a)=\eta\cdot \max(0,\tau-\mu F_n)^2
$$
that can be added to the reward if violated, or the action can instead be marked infeasible. The planner therefore couples safety to both hard feasibility and soft cost shaping [2309.15283].

Collision avoidance and workspace limits are also explicit. Every trajectory is post-checked against the environment’s collision geometry. Table-plane containment is required for $M^{slide}$ with $z=\text{const}$, whereas $M^{transfer}$ requires $z>z_{table}$, and hands must remain in the robot’s reachable polytope. The reward uses a negative-step cost with terminal rewards,
$$
R(s,a,s')=
\begin{cases}
+R_{success} & s'\in S_{goal}\\
-R_{fail} & s'=s_{fail}\\
-c_{step}-c_{orient}(a) & \text{otherwise},
\end{cases}
$$
so that regrasp plans are optimized not only for goal achievement but also for fewer steps and smaller orientation swings [2309.15283].

The transition model further exposes safety and uncertainty at the planning level. If $\rho_a\in[0,1]$ is the success probability of action $a$, then
$$
T(s'|s,a)=
\begin{cases}
\rho_a & \text{if } s' \text{ is the planned result of } a\\
1-\rho_a & \text{if } s'=s_{fail},
\end{cases}
$$
with all other entries zero. Initially, $\rho_a=1.0$ for inter-manifold actions and $\rho_a=0.5$ for intra-manifold actions until tried. On failure, $\rho_a\leftarrow \rho_a\cdot 0.5$ and similar slide actions are also reduced; on success, $\rho_a\leftarrow \min(1,\rho_a+0.1)$; and actions with $\rho_a<\epsilon$ are pruned, with $\epsilon=0.1$ given as an example. This makes safety adaptive: the planner updates its belief about which regrasp actions are reliable and removes hopeless actions during replanning [2309.15283].

## 4. Execution-level safe regrasp on the Doosan M0609

The 2025 safe ZYZ regrasp routine is an execution algorithm for singularity-safe motion planning on a Doosan M0609 collaborative robot. Its input includes the current joint state $q_{cur}$, the desired end-effector pose $T_{target}=[R(\alpha,\beta,\gamma),p_{target}]$, a singularity threshold $\epsilon=0.1$ rad, a manipulability threshold $\mu_{min}$, the robot model with joint limits, and a collision-checking module. The procedure first extracts $(\alpha,\beta,\gamma)=eulerZYZ(R_{target})$, computes $\mathrm{PI}=1-|\cos\beta|$, and branches according to singularity risk [2508.21272].

If $\mathrm{PI}>0.9$ or $|\beta|>90^\circ-\epsilon$, the controller clamps $\beta_{safe}\leftarrow \text{clamp}(\beta,-89.9^\circ,+89.9^\circ)$ and constructs an intermediate wrist-roll pose
$$
T_{int}=T_{current}\cdot R_z(\pm 90^\circ).
$$
It then solves IK for $T_{int}\Rightarrow q_{int}$ and for
$$
T_{safe}=[R(\alpha,\beta_{safe},\gamma),p_{target}]\Rightarrow q_{safe},
$$
subject to joint-limit, collision, and manipulability checks. If a valid sequence exists, it executes the two-step motion $q_{cur}\rightarrow q_{int}\rightarrow q_{safe}$ and returns success. If not, the fallback is a systematic 6-step regrasp sequence: apply small $\delta$-rotation on wrist J5 $(\pm 90^\circ)$, retract 50 mm in Z and open gripper, rotate tool by $[0,0,90^\circ]$, close gripper, attempt IK to $T_{target}$, and, if success and safe, execute and exit the loop. If no singularity risk is detected, the system attempts direct IK to $q_{goal}$ and executes a direct motion if the result is safe; otherwise it also falls back to the 6-step sequence [2508.21272].

This execution layer is specialized to the Doosan M0609. The cited specification includes joint limits
for $J1,J4,J6\in[-360^\circ,+360^\circ]$, $J2\in[-95^\circ,+95^\circ]$, and $J3,J5\in[-135^\circ,+135^\circ]$, as well as velocity limits
$$
\dot q_{max}=[180,180,225,225,225,225]^\circ/s.
$$
The regrasp fallback uses Cartesian-linear moves for safe retraction by moving the tool +Z by 50 mm, followed by pure wrist rotations on joint 5. Trajectory generation uses MoveIt2’s time-parameterized planner with jerk limits of 2 m/s\(^3\) on linear segments and 10 rad/s\(^3\) on joints, and gripper force is closed-loop controlled to 15 N target with $K_p=0.5$, minimizing slip during mid-air rotations [2508.21272].

The paper also reports an illustrative example trajectory in which an orientation change from $\beta\approx 89^\circ$ to $\beta\approx 60^\circ$ is achieved via a 2-step rotation. The direct wrist-only trajectory fails IK, whereas the intermediate regrasp rotates tool Z by $+90^\circ$, lifts 50 mm in Z, recloses the gripper, and rotates to the final $(\alpha,\beta_{safe},\gamma)$ while maintaining manipulability $\mu(q)>0.02$ throughout. This concrete example clarifies that “safe” in the execution sense includes both singularity avoidance and maintenance of acceptable manipulability [2508.21272].

## 5. Integration with decision-making and constrained task planning

In the 2023 multi-modal formulation, planning proceeds by value iteration:
$$
v_{k+1}(s)=\max_a \sum_{s'}T(s'|s,a)\bigl[R(s,a,s')+\gamma v_k(s')\bigr],
$$
followed by extraction of the greedy policy $\pi^*(s)=\arg\max_a \ldots$ and policy rollout from $s_{init}$ until hitting $S_{goal}$ or $s_{fail}$. The practical pipeline is explicitly enumerated: segment the object, estimate its COM, run ContactGraspNet to get grasps $\{g\}$, label grasps high or low by $\tau=mg\,\|\Delta COM\|$ versus $\mu F_n$, construct the three foliations, enumerate inter- and intra-manifold actions, check kinematic, dynamic, and collision feasibility, build the MDP $(S,A,T,R)$, run value iteration, extract the task sequence of manifold-constrained motion queries, call a constrained Lazy-PRM with projection onto manifold to compute each trajectory, and, on failure, update the $\rho$ values, prune hopeless actions, and re-compute $\pi^*$. The stated result is a motion plan that never violates the friction-stability condition, respects Z–Y–Z orientation limits, avoids collisions and stays in the robot’s workspace, and is optimized in expectation for few failures and minimal reorientations [2309.15283].

In the 2025 system, safe ZYZ regrasp is embedded in the legal-action mask of the assembly MDP. The paper defines
$$
\text{reachable}(a)=\exists\,q:\;f_k(q)=\text{target\_pose}(a)\;\land\;\lnot\text{collision}(q)\;\land\;q_j^{min}\le q_j\le q_j^{max},
$$
and states that, in practice, “reachable” now includes whether a safe Z–Y–Z regrasp sequence can be found. If pure IK to $R(\alpha,\beta,\gamma)$ fails due to near-singularity, the controller invokes the safe regrasp procedure; if that finds a kinematically and collision-free path, the action remains in the mask, otherwise it is masked out. The safety-guard logic lives entirely inside the `environment.step(...)` call, so the DQN never “sees” a crash—illegal regrasp merely becomes an illegal action [2508.21272].

The same work places safe regrasp inside a hierarchical architecture that decomposes Q-function estimation into orientation and position components, reducing computational complexity from $O(3,132)$ to $O(116)+O(27)$ while maintaining solution completeness. This suggests a division of labor between symbolic or discrete decision layers and continuous safety layers: the RL system chooses an orientation-position pair, while the regrasp controller certifies whether that choice is executable without singularity, collision, or joint-limit violation [2508.21272].

## 6. Robust external-contact variants, empirical results, and interpretation

A distinct but closely related safety notion appears in fixtureless fixturing. There, the robot pushes the object against external contact so that the external contact keeps the object stationary while the fingers slide over the object. The mechanics are formulated through a generalized friction cone at a pusher, a quasi-static force balance for a sticking push under gravity-balancing orientation, and a robust motion cone in twist space. The key parameter-free condition is
$$
-J_c^T\bar w_c\in W_{pusher},
$$
which is then mapped to the convex cone of achievable instantaneous twists
$$
V_{obj}=\text{cone}\{v^1,\ldots,v^K\},
$$
or equivalently to the half-space form
$$
U=\{u\in\mathbb{R}^3\mid A u\le 0\}.
$$
Because, in the gravity-balanced formulation, the terms $mg$, $N$, and $\mu_c$ cancel out, the only remaining parameter is the pusher friction cone, which is conservatively approximated using $\mu_{pmin}$. The resulting robust push-set yields safe sticking pushes under the modeled uncertainties [1809.08522].

Planning in that framework grows a T-RRT* tree in the 3D grasp-pose space $q=[X,Z,\theta_y]$, and the key safety check is `projectOntoCone`, which ensures that the small twist applied lies inside a robust motion cone $U_i$, thus guaranteeing a sticking push under all modeled uncertainties. The cost function
$$
\text{Cost(node)}=\text{Cost(parent)}+(0.1\ \text{if same pusher as parent, else }1)
$$
biases the planner against pusher switch-overs, because each switch incurs noise. Although this framework is not expressed as a Z–Y–Z wrist singularity problem, it is directly relevant to safe regrasp strategies because it formalizes regrasp safety through uncertainty-invariant contact mechanics rather than through Euler-angle guards [1809.08522].

The empirical results across the cited works illustrate several distinct notions of success. In fixtureless fixturing, planner time was 0.39 s for a 20 mm horizontal offset regrasp, 0.65 s for a general $[X,Z,\theta_y]$ regrasp on a rectangular prism, and 0.60 s for a T-shaped nonconvex object; the T-shaped object showed 20 consecutive open-loop trials under varied grasp forces with zero failures, and changing $\mu_c$ via grasp-force variation had no effect on outcome [1809.08522]. In the MDP-based multi-modal planner, the authors report improved performance in both simulation and the real world for pick-and-place tasks [2309.15283]. In the Doosan M0609 system, curriculum learning across three progressive difficulty levels achieved 100\% success rate for Level 1 within 500 episodes, 92.9\% for Level 2, and 39.9\% for Level 3 over 105,300 total training episodes, and embedding the safe-regrasp routine in the action-masking and execution layers raised motion-success from 54 % to 96 % in real-world trials while enabling placement of every Soma piece in all 116 orientations without gimbal-lock failures [2508.21272].

The cited work therefore indicates that safe ZYZ regrasp should not be reduced to a singularity workaround alone. In the MDP formulation, safety includes friction-stability, collision avoidance, workspace containment, and expected-failure minimization. In the Doosan execution stack, safety includes $\beta$-proximity guards, manipulability thresholds, joint limits, collision checks, smooth trajectory generation, and slip-aware gripper control. In fixtureless fixturing, safety is expressed as robustness of sticking pushes under uncertainty. A plausible implication is that “safe ZYZ regrasp” is best understood as one member of a broader family of safe regrasp strategies in which orientation representation, contact mechanics, and task-level action filtering are tightly coupled rather than isolated design choices.

Source: https://www.emergentmind.com/topics/safe-zyz-regrasp-strategies