MEKAWIRE
进阶arXiv

面向水培生菜采摘机器人路径安全目标到达的仿真到现实强化学习

Al Bashir, Partho Ghose, Yibin Wang, Robert G. Hardin, Joshua Peeples, Genhua Niu, Azlan ZahidTexas A&M University (Biological and Agricultural Engineering, Electrical and Computer Engineering, Horticultural Sciences) and Texas A&M AgriLife Research
30 秒速读

美国得克萨斯农工大学预印本显示,一个只在仿真中训练的到达策略在真实UR10e机械臂上命中150个目标中的142个(94.7%),高于三种传统运动规划器的80.0%至88.0%,整套温室系统在144次尝试中完成86.1%的水培生菜采收。对农业机器人厂商而言,机械臂路径已不是瓶颈,剩余损失集中在切割工具与作物接触环节。

研究问题

完全在仿真中训练的控制器,能否在狭窄的栽培槽之间把采摘机械臂可靠且平稳地送到视觉识别出的生菜切割点,并在不做真实环境微调的情况下胜过标准运动规划器?

问题

在营养液膜(NFT)水培中,切割工具必须从侧面以正确角度接近刚性栽培槽上方的茎根部位,且不能碰到相邻植株。仅到达终点并不够,若轨迹低于栽培槽平面或扫过作物,任务仍算失败,抖动的动作也会扰动植株。

既有方法

剑桥大学Vegebot等生菜采摘机结合了学习式感知、力反馈和专用末端执行器。农业路径规划研究多用RRTConnect、RRT*等采样规划器,或笛卡尔插值加时间最优轨迹生成(TOTG),优化规划时间、路径长度和平顺性。此前没有方法把相机给出的切割点直接转化为天然满足通道与间隙约束的学习式动作。

新方法

作者保留标准PPO裁剪目标,但按采摘任务重新设计问题。策略接收目标位置,被奖励引导从侧向通道进入,用近期轨迹历史编码安全信息,只有在不低于栽培槽平面的前提下到达才算成功。训练全部在英伟达Isaac Lab完成,再经ROS部署到UR10e,配合动作滤波、独立的硬件加速度限制、输出三维切割点的RGB-D相机,以及可切割、夹持并投放到收集篮的自研末端执行器。

结果

仿真中200个目标的严格成功为184个(92.0%)。去掉路径安全项后降至63.5%,下降28.5个百分点;去掉侧向通道塑形后终点精度提高,但严格成功率反而下降。真实UR10e的150个目标中,该策略到达142个(94.7%),RRTConnect为132个(88.0%),笛卡尔插值加TOTG为129个(86.0%),RRT*为120个(80.0%),最终接近段RMS加加速度中位数低39.8%至73.0%。传统规划器的终点精度和路径直接性更好。在达拉斯得州农工AgriLife研究中心温室的144次尝试中,系统对在线RGB-D切割点的到达率为94.4%,完整采收成功率为86.1%。

局限

该研究为预印本。消融实验每个变体只评估一个训练检查点,未衡量重训练波动。部分平顺性优势来自动作滤波和硬件加速度保护而非学习策略,作者表示尚无法拆分。“路径安全”是基于间隙判据的工程定义,并非形式化安全保证。实验只覆盖一种作物、一种栽培槽布局和一种机械臂,失败的采收都发生在成功到达之后的切割与夹持阶段。

产业影响

中国植物工厂和温室装备企业多采用协作机械臂,这类方法可在英伟达仿真器中训练接近控制器,减少为密集栽培布局手工调规划器的工作。对研发采摘机器人的厂商更关键的是损失所在:带接触感知的切割与夹持属于一到两年内可完成的产品工程,而学习式到达已可在设施农业中部署。

论文全文

Sim-to-Real Reinforcement Learning for Path-Safe Target Reaching in Robotic Harvesting of Hydroponic Lettuce

Al Bashir, Partho Ghose, Yibin Wang, Robert G. Hardin, Joshua Peeples, Genhua Niu, Azlan Zahid

本文依据 CC BY 4.0 许可发布,经署名转载,原文见 arXiv:2610.22337(PDF)。

[orcid=0000-0003-2168-2840]

[orcid=0000-0002-5840-2008]

[orcid=0000-0002-8761-5387]

[orcid=0000-0001-7861-7789]

[orcid=0000-0001-6202-8680]

Abstract

Robotic harvesting requires precise manipulation to ensure accurate positioning of the end-effector, especially in a constraint workspace. This study introduces the Path-Safe Approach Proximal Policy Optimization (PSA-PPO), a target-conditioned local reaching framework designed for robotic harvesting of nutrient film technique (NFT)-hydroponic lettuce in greenhouses. The proposed PSA-PPO preserves the standard clipped PPO objective while introducing a harvesting-oriented policy formulation that integrates target-conditioned observations, corridor-aware spatial constraints, trajectory-history-based safety encoding, and task-specific success criteria for constrained robotic manipulation. PSA-PPO was trained entirely in Isaac Lab and successfully transferred to a physical UR10e robotic arm without any real-world policy fine-tuning. In a controlled physical benchmark against 150 scheduled targets, PSA-PPO achieved the highest reaching rate of 94.7%, outperforming Cartesian+TOTG (86.0%), RRTConnect (88.0%), and RRT* (80.0%), while reducing median RMS jerk by 39.8–73.0% relative to the classical planners during the final approach segment. A formulation ablation evaluated over 200 simulation targets demonstrates that path-safety and side-corridor shaping are the principal drivers of harvesting-compatible performance: removing either term substantially degrades strict success even when terminal endpoint accuracy is preserved or improved, confirming that optimization toward the endpoint alone is an insufficient objective for constrained crop-proximal manipulation. Finally, PSA-PPO was integrated with an RGB-D vision module and an end-effector and evaluated as a complete greenhouse harvesting system across 144 lettuce harvesting attempts, achieving 94.4% vision-guided target reaching and 86.1% complete harvesting success. These results position PSA-PPO as an effective simulation-trained harvesting motion controller that balances target-reaching reliability and low dynamic excitation.

††††††††

1 Introduction

Reliable manipulator motion remains a critical challenge in robotic harvesting because crop localization, target approach, and physical crop interaction must be executed within highly constrained and variable agricultural environments [28, 21]. Unlike structured industrial manipulation, crop targets vary continuously in geometry, accessibility, and are surrounded by deformable plant material and cultivation infrastructure [14, 41, 10]. These constraints become especially important in controlled-environment agriculture, where dense crop layouts restrict manipulator workspace while increasing the requirement for repeatable autonomous operation [37]. Hydroponic lettuce presents a unique challenge in terms of manipulation. The harvesting tool must approach the stem–root region, just above the cultivation infrastructure, establish the right cutting angle, sever the plant, retain the detached lettuce, and transfer it without disturbing neighboring crops or rigid cultivation equipment [39]. Early research on lettuce harvesting demonstrated the effectiveness of machine-vision-guided manipulation within structured production systems [7]. More recent studies have continued to improve crop-specific harvesting mechanisms and the interactions of end effectors, highlighting the importance of combining crop localization with subsequent robotic actions [40, 3]. For instance, the field-tested Vegebot integrated learned perception, force-feedback control, and a specialized end effector designed for iceberg lettuce harvesting [5]. However, these studies do not address how to convert a vision-derived cutting point for lettuce into a repeatable motion that complies with the geometry and clearance constraints of a complex agricultural environment.

Figure 1: Overview of the proposed sim-to-real PSA-PPO harvesting framework. The robot-mounted RGB-D camera provides RGB imagery and aligned depth to the lettuce perception module, which generates temporally smoothed 3D cutting-point targets. PSA-PPO is trained entirely in Isaac Lab for target-conditioned, path-safe side-approach reaching. During physical deployment, the frozen policy and vision-derived targets are integrated through the ROS action-control layer to command the UR10e for side-approach harvesting of nutrient film technique (NFT)-grown lettuce.

Manipulator motion in agricultural harvesting is still predominantly generated using inverse kinematics, sampling-based motion planning, trajectory optimization, or visual servoing. Researchers have adapted these methods to crop-specific manipulation requirements. For example, Ma et al. [22] developed an improved BIT*-based planner [16] that jointly considered path quality, execution efficiency, and dynamic impact. Rong et al. [29] coordinated manipulator and lifting-joint motion to improve tomato-harvesting reachability, while Kang et al. [15] proposed a BIT*-based Time-Optimal and Path-Optimal (TOPO) planner that combines improved sampling and edge checking with path optimization to reduce planning time and generate shorter trajectories for selective broccoli harvesting. Recent studies have similarly modified Informed-RRT* [16] for smooth winter-jujube harvesting [11] and developed a sampling-based planner for high-quality motion generation in unstructured tea canopies [12]. At the system level, visual-servoing approaches [6] remain common for cucumber harvesting [25, 13]. Classical planners [34, 23, 18] therefore provides strong geometric trajectory and can achieve high terminal precision, but agricultural manipulation requires simultaneous consideration of reachability, obstacle exposure, trajectory smoothness, perception uncertainty, execution robustness, and crop-specific approach geometry [9, 41]. Additionally, these planners are vulnerable to singularities, sensitive to noise which often produce unstable motion and inefficient trajectories [19, 27].

Learning-based policy control offers a complementary approach for achieving smooth motion through learning loops between the robot agent and its environment. Proximal Policy Optimization (PPO) [31] has become a widely used method in Deep Reinforcement Learning (DRL) for continuous robotic control [35]. It uses a policy-gradient method that constrains policy updates through a clipped surrogate objective. However, this mechanism does not explicitly enforce geometric or trajectory-safety constraints; constraint-aware policy optimization remains a distinct problem [1]. For harvesting, a policy rewarded primarily for terminal target acquisition may reach the cutting point without preserving an acceptable approach direction, tool orientation, or intermediate clearance. Addressing this limitation requires a task formulation that represents the relevant spatial relationships, evaluates trajectory-level violations, and distinguishes terminal reaching from harvesting-compatible motion rather than relying on the standard PPO objective alone. A further significant challenge in DRL training is acquiring the necessary interaction experience of robot through trial and error. Policy optimization involves repeated robot motions and resets, substantial execution time, and potentially unsafe exploratory actions. These challenges are particularly critical in agricultural environments, where exploratory actions can damage delicate biological materials, harvesting infrastructure, or the manipulator itself [8, 35]. These limitations highlight the need to develop manipulation DRL policies without relying on exploratory policy optimization in a physical robot.

Simulation-based policy learning offers a fundamentally different development path. Instead of gathering the extensive interaction data required for policy optimization on a physical harvesting robot, both exploration and policy learning can be carried out in a virtual physics simulator, allowing the learned policy to be evaluated on hardware later. GPU-native simulation has made this approach increasingly feasible. For instance, NVIDIA Isaac Lab [24], a unified GPU-accelerated framework for reinforcement learning, showcases massively parallel robot-policy interactions directly on the GPU.

However, simulation-trained policies must overcome the reality gap yielded by imperfect dynamics, actuator behavior, sensing, and calibration variation. Previous research has addressed these discrepancies through visual and dynamics randomization [36, 26] and physical parameter identification [32]. For example, Subedi et al. [33] demonstrated simulation-only RL transfer for occlusion-aware plant manipulation by separating learned behavior from lower-level compliant control. Kim et al. [17] used visuomotor imitation learning for autonomous pepper harvesting in unstructured fields, while Rong et al. [30] combined position-based visual alignment with a corrective action policy for greenhouse tomato harvesting. However, there remains limited evidence for policies that simultaneously incorporate crop-specific approach geometry, trajectory-history clearance, simulation-only policy optimization, controlled physical comparison with multiple classical planners, and end-to-end harvesting in complex agricultural setups. Moreover, success in simulation alone does not guarantee physical reliability; evaluations of paired robots and policies have highlighted the importance of addressing control and observation discrepancies [20]. For effective crop-proximal harvesting, it is essential to preserve the learned control interface while also accommodating the constraints of physical calibration and execution. This research gap is crucial to greenhouse-grown lettuce because successful reaching cannot be defined solely by the final tool center point (TCP) error. The cutter must approach the stem region from a suitable horizontal direction, remain compatible with the target-height geometry, preserve the required tool orientation, limit wrist–TCP descent near the cultivation structure, and avoid undesirably abrupt local motion. Hence, this control problem is consequently one of harvesting-compatible local constrained reaching, rather than generic point-to-point motion alone.

To address these gaps, this study develops Path-Safe Approach PPO (PSA-PPO), a target-conditioned local reaching formulation for hydroponic lettuce harvesting. Rather than modifying PPO’s optimization rule, PSA-PPO reformulates the learning task through geometry-conditioned safe initialization, target- and clearance-aware observations, coupled reaching and motion-safety rewards, and trajectory-history-dependent strict capture and termination criteria for collision-avoidance harvesting-specific trajectories. The policy is trained entirely in Isaac Lab and transferred without real-world policy fine-tuning, using calibrated target transformation, a frozen Cartesian deployment correction, and an independent ROS execution and safety interface. The study then examines whether harvesting-compatible behavior learned in simulation is retained on a physical UR10e, how it compares with classical motion planners, and how it performs within a complete vision-guided greenhouse harvesting system.

The main contributions of this study are:

  1. A target-conditioned path-safe local reaching formulation, named PSA-PPO, is developed for lettuce harvesting. It incorporates spatial constraints, trajectory-level safety awareness, and harvesting-specific task objectives.
  2. The PSA-PPO is trained entirely in simulation, without any physical rollouts used for policy optimization or fine-tuning. The trained policy is evaluated against the identical 200 targets within the simulation, highlighting contributions such as path-safety shaping, side-corridor shaping, and motion regularization.
  3. The simulation-trained policy is transferred to a physical UR10e robotic arm and is benchmarked against Cartesian+TOTG, RRTConnect, and RRT* algorithms over 150 common targets. This comparison assesses task reliability, terminal precision, target convergence, physical motion dynamics, joint tracking, and trajectory geometry, revealing the trade-offs involved in the controller.
  4. PSA-PPO is integrated with an RGB-D-based lettuce vision module for target streaming and a end-effector mechanism in a complete greenhouse harvesting pipeline. Across 144 actual lettuce harvesting attempts, the system achieved 94.4% target reaching success.

2 Methodology

The proposed PSA-PPO motion controller framework integrates with a previously developed lettuce cutting-point localization perception module and cut-and-hold mechanism [4, 3], creating a complete pipeline. The policy is entirely trained in a simulation environment and then transferred to the physical robot without any fine-tuning required in the real world. Figure 1 illustrates the resulting perception-learning-deployment pipeline.

2.1 3D Target Streaming

The perception interface extended our previously developed lettuce segmentation and occluded cutting-point localization method [4] to RGB-D target streaming. The vision method provided the image-space cutting-point pixel (u_{c},v_{c}). Using depth aligned to the RGB frame, the corresponding depth Z_{c} and RGB camera intrinsics (f_{x},f_{y},c_{x},c_{y}) were used to back-project the cutting point into the camera coordinate frame. A fixed camera-frame Y-axis offset d_{y} was then applied to provide clearance from the NFT channel:

\mathbf{p}_{cut}^{cam}=\begin{bmatrix}\dfrac{(u_{c}-c_{x})Z_{c}}{f_{x}}\\[5.0pt]
\dfrac{(v_{c}-c_{y})Z_{c}}{f_{y}}-d_{y}\\[5.0pt]
Z_{c}\end{bmatrix},\qquad d_{y}=5~\mathrm{mm}
(1)

To overcome frame-to-frame variation caused by depth noise and segmentation fluctuations, cutting-point estimates were temporally associated and averaged before robot execution. Let \mathbf{s}_{t}^{(j)}=[u_{t}^{(j)},v_{t}^{(j)}]^{\top} denote the image-plane tracking center of segmented mask j at frame t, and let \hat{\mathbf{s}}_{t-1}^{(k)} denote the latest center associated with active track k. Each detection was matched to its nearest existing track:

k^{\ast}(j)=\arg\min_{k\in\mathcal{K}_{t-1}}\left\|\mathbf{s}_{t}^{(j)}-\hat{\mathbf{s}}_{t-1}^{(k)}\right\|_{2},
(2)

where the assignment was accepted only when the image-plane distance was below \tau_{p}=50 pixels; otherwise, a new track was initialized. Each active track maintained a fixed-length buffer of 3D cutting-point estimates, from which the streamed target was computed as:

\bar{\mathbf{p}}_{cut}^{(k)}=\frac{1}{N_{b}}\sum_{n=1}^{N_{b}}\mathbf{p}_{cut,n}^{(k)},\qquad N_{b}=15
(3)

The averaged point was published as a ROS PointStamped message in the camera optical frame. The buffer was cleared after publication, and tracks not observed in the current frame were removed to prevent stale targets from propagating to the harvesting controller.

2.2 Simulation-Trained Policy for Path-Safe Side-Approach Target Reaching

Figure 2: Training architecture of the path-safe, side-corridor approach policy (PSA-PPO) for the UR10e manipulator. Each target \mathbf{p}^{T} defines a horizontal approach direction \mathbf{a}^{T} and same-height staging reference \mathbf{p}^{S} and determines a geometry-conditioned safe-start configuration. The actor receives the 42-dimensional policy observation \boldsymbol{\xi}_{t} and produces a six-dimensional action \bar{\mathbf{u}}_{t}, which is bounded, filtered, and scaled before application. The environment evaluates target closure, corridor following, tool orientation, wrist–TCP path safety, and motion regularity. Rollout data and critic estimates are used to compute returns and advantages for the clipped PPO update. The selected actor checkpoint is subsequently validated in simulation and exported for physical deployment.

PSA-PPO was trained entirely in Isaac Lab [24] as a target-conditioned policy for the final local harvesting approach. Rather than learning the complete motion from a fixed global home configuration, the task was decomposed into deterministic target-conditioned pre-positioning followed by local reaching. Policy optimization was therefore restricted to the final approach region, where target closure, side-entry geometry, tool orientation, and wrist–TCP clearance are most relevant to harvesting. Figure 2 summarizes the training architecture.

Let \mathbf{p}^{T}=[p_{x}^{T},p_{y}^{T},p_{z}^{T}]^{\top} denote the target TCP position. The target-conditioned horizontal approach direction and same-height staging reference were defined as:

\mathbf{a}^{T}=\frac{[p_{x}^{T},\,p_{y}^{T},\,0]^{\top}}{\sqrt{(p_{x}^{T})^{2}+(p_{y}^{T})^{2}}},\qquad\mathbf{p}^{S}=\mathbf{p}^{T}-d_{a}\mathbf{a}^{T}
(4)

where d_{a} is the staging-to-target distance. Because \mathbf{a}^{T} has no vertical component, \mathbf{p}^{S} and \mathbf{p}^{T} have the same height.Each target was sampled before initialization, and its radius, azimuth, and height were used to deterministically select a geometry-conditioned safe-start joint configuration. The robot was therefore initialized near the corresponding local approach region and started the side approach corridor motion towards the target.

The reaching task was implemented as a finite-horizon reinforcement-learning process. The environment maintained trajectory-level variables required for reward and termination evaluation, whereas the actor received the following 42-dimensional observation at policy step t:

\begin{split}\boldsymbol{\xi}_{t}=&\left[\widetilde{\mathbf{q}}_{t},\;\widetilde{\dot{\mathbf{q}}}_{t},\;\mathbf{p}^{T},\;\mathbf{p}^{S},\;\mathbf{e}^{T}_{t},\;\mathbf{e}^{S}_{t},\;\mathbf{u}_{t-1},\;\right.\\
&\quad\quad\quad\quad\quad\quad\left.\ell_{t},\;g_{t},\;c_{t}^{a},\;c_{t}^{z},\;\mathbf{a}^{T},\;\mathbf{h}_{t}\right]\end{split}
(5)

where \widetilde{\mathbf{q}}_{t} and \widetilde{\dot{\mathbf{q}}}_{t} are the scaled joint positions and velocities, \mathbf{e}^{T}_{t}=\mathbf{p}^{T}-\mathbf{p}^{tcp}_{t} and \mathbf{e}^{S}_{t}=\mathbf{p}^{S}-\mathbf{p}^{tcp}_{t}, and \mathbf{u}_{t-1} is the previous action. The normalized corridor progress was \ell_{t}=((\mathbf{p}^{tcp}_{t}-\mathbf{p}^{S})^{\top}\mathbf{a}^{T})/d_{a}, while g_{t} indicated activation of the staging-to-target corridor. Tool orientation was represented by c_{t}^{a}=\mathbf{f}_{t}^{\top}\mathbf{a}^{T} and c_{t}^{z}=|\mathbf{f}_{t}^{\top}\mathbf{e}_{z}|, where \mathbf{f}_{t} is the tool forward axis and \mathbf{e}_{z}=[0,0,1]^{\top}. Thus, the desired side-approach orientation corresponds to c_{t}^{a}\rightarrow 1 and c_{t}^{z}\rightarrow 0. The clearance vector \mathbf{h}_{t}\in\mathbb{R}^{5} contains the three wrist-link clearances, TCP clearance, and their minimum value relative to the target-height safety plane. The resulting observation contained 42 elements.

The stochastic actor produced the normalized raw action \bar{\mathbf{u}}_{t}\in\mathbb{R}^{6}, which was clipped and temporally filtered before being converted to an incremental joint-position command:

\begin{split}\mathbf{u}_{t}=&(1-\alpha)\mathbf{u}_{t-1}+\alpha\,\operatorname{clip}\left(\bar{\mathbf{u}}_{t},-1,1\right),\\
\mathbf{q}^{cmd}_{t}&=\operatorname{clip}_{\mathbf{q}^{min},\mathbf{q}^{max}}\left(\mathbf{q}_{t}+s_{u}\mathbf{u}_{t}\right)\end{split}
(6)

where \alpha is the temporal-filter coefficient, s_{u} is the action scale, and \mathbf{q}^{min} and \mathbf{q}^{max} are the UR10e soft joint limits.

To separate target closure from corridor deviation, let \mathbf{a}^{\perp}=[-a_{y}^{T},a_{x}^{T},0]^{\top}. The target-frame errors were-

\begin{split}&e_{t}^{ax}=(\mathbf{p}^{T}-\mathbf{p}^{tcp}_{t})^{\top}\mathbf{a}^{T},\qquad e_{t}^{lat}=(\mathbf{p}^{T}-\mathbf{p}^{tcp}_{t})^{\top}\mathbf{a}^{\perp},\\
&e_{t}^{z}=p_{z}^{T}-p_{z,t}^{tcp}\end{split}
(7)

Path safety was evaluated from the three wrist links and TCP, denoted collectively by \mathcal{C}. Their minimum clearance, instantaneous below-plane violation, and maximum accumulated violation were-

\begin{split}&h_{t}^{min}=\min_{i\in\mathcal{C}}\left(z_{t}^{(i)}-p_{z}^{T}\right),\qquad b_{t}=\max(0,-h_{t}^{min}),\\
&b_{t}^{max}=\max_{0\leq\tau\leq t}b_{\tau}\end{split}
(8)

Thus, a trajectory that temporarily passed below the target-height plane could not be classified as path-safe solely from its final configuration.

The instantaneous reward combined target progress, side-approach corridor tracking, orientation, path safety, motion regularization, and terminal capture:

\mathcal{R}_{t}=\mathcal{R}^{tar}_{t}+\mathcal{R}^{cor}_{t}+\mathcal{R}^{ori}_{t}+\mathcal{R}^{safe}_{t}+\mathcal{R}^{reg}_{t}+\mathcal{B}_{t}
(9)

The target component rewarded TCP-to-target closure, axial progress, forward corridor progression, and entry into increasingly tight target neighborhoods. The corridor component penalized lateral and vertical departure, axial overshoot, and loitering near the staging region without continued target closure. The orientation component promoted alignment of the tool axis with \mathbf{a}^{T} while penalizing vertical tilt. The safety component penalized instantaneous and accumulated target-height-plane violation, and the regularization component penalized action magnitude, action-rate variation, action acceleration, and joint velocity.

A valid capture required simultaneous positional, orientation, and instantaneous-clearance conditions, whereas strict capture additionally required the complete learned path and initial safe-start configuration to satisfy the path-safety tolerance:

\begin{split}&\chi_{t}=\mathbb{I}\Big[|e_{t}^{ax}|<\varepsilon_{ax}\land|e_{t}^{lat}|<\varepsilon_{lat}\land|e_{t}^{z}|<\varepsilon_{z}\\
&\quad\quad\land\;d_{t}^{T}<\varepsilon_{d}\land c_{t}^{a}>\varepsilon_{a}\land c_{t}^{z}<\varepsilon_{v}\land h_{t}^{min}>0\Big],\\[1.0pt]
&\chi_{t}^{strict}=\chi_{t}\,\mathbb{I}\left[b_{0}\leq\varepsilon_{safe}\land b_{t}^{max}\leq\varepsilon_{safe}\right]\end{split}
(10)

where d_{t}^{T}=\|\mathbf{p}^{T}-\mathbf{p}^{tcp}_{t}\|_{2} and b_{0} is the below-plane violation at initialization. The capture reward was \mathcal{B}_{t}=c_{b1}\chi_{t}+c_{b2}\chi_{t}^{strict}, with the larger contribution assigned to path-safe capture. Successful termination required \chi_{t}^{strict}=1 for N_{s} consecutive policy steps, whereas b_{t}^{max}>\varepsilon_{hard} terminated the episode early.

The actor and critic were trained using PPO with the RSL-RL backend in Isaac Lab. Let \pi_{\theta}(\bar{\mathbf{u}}_{t}|\boldsymbol{\xi}_{t}) and V_{\varphi}(\boldsymbol{\xi}_{t}) denote the actor and critic, respectively. Generalized advantage estimation provided \widehat{A}_{t} and \widehat{G}_{t}, and the actor was updated using:

\begin{split}\mathcal{J}_{\mathrm{PPO}}(\theta)=&\mathbb{E}_{t}\left[\min\left(\rho_{t}(\theta)\widehat{A}_{t},\right.\right.\\
&\quad\quad\quad\left.\left.\operatorname{clip}\left(\rho_{t}(\theta),1-\epsilon,1+\epsilon\right)\widehat{A}_{t}\right)\right]\end{split}
(11)

where \rho_{t}(\theta)=\frac{\pi_{\theta}(\bar{\mathbf{u}}_{t}|\boldsymbol{\xi}_{t})}{\pi_{\theta_{\mathrm{old}}}(\bar{\mathbf{u}}_{t}|\boldsymbol{\xi}_{t})}. The critic was optimized by value-function regression, with entropy regularization retained during training.

Training targets were sampled over the practical front workspace using horizontal polar coordinates and area-uniform radial sampling. A hard-region mixture increased exposure to far-radius, negative-lateral, low- and high-height, and near-boundary azimuth configurations. Candidate checkpoints were subsequently evaluated on an independent random-workspace simulation set; however crop cutting and plant interaction were not used for policy optimization. Workspace bounds, safe-start settings, component definitions, activation gates, reward coefficients, capture and safety thresholds, network parameters and the terms removed in each formulation ablation are reported in Appendix A and B.

2.3 End-Effector Integration

Figure 3: Redesigned cut-and-hold lettuce harvesting end effector. (a–f) SolidWorks components and assembled geometry, including top, bottom, side, open, and closed configurations; (g) fabricated mechanism mounted on the OnRobot 2FG7 and UR10e manipulator.

The harvesting tool adapted our previously developed lettuce cut-and-hold end effector [3] for direct actuation by an OnRobot 2FG7 gripper. The redesigned components were modeled in SolidWorks 2026 (Dassault Systèmes, Vélizy-Villacoublay, France) and 3D-printed using fused deposition modeling (FDM) with polylactic acid (PLA) filament (Figure 3). The original 2FG7 fingers were replaced by custom brackets carrying paired holding fingers and shear blades while retaining the first-class lever cutting principle. A single gripper closing action therefore actuated the shear mechanism and simultaneously retained the detached lettuce for transfer.

2.4 ROS-Based Deployment and Harvest Sequencing

Figure 4: ROS-based harvesting-control architecture. Smoothed RGB-D cutting points are transformed to the robot frame and corrected for end-effector geometry. The harvest controller performs target-conditioned pre-positioning before activating the PSA-PPO policy for the learned local side approach. Policy outputs are mapped to UR10e joint commands through the ROS trajectory interface, with independent hardware-side timing and acceleration safeguards. A separate gripper-control branch actuates the 2FG7-driven cut-and-hold mechanism and releases harvested lettuce at the collection basket.

The selected PSA-PPO actor was integrated with the ROS harvesting architecture shown in Figure 4. Simulation validation used randomly generated workspace targets, whereas physical harvesting received smoothed cutting points from the RGB-D perception module (Sec. 2.1); the target-conditioned geometry and learned local-reaching formulation were otherwise retained during deployment.

At the beginning of a harvesting sequence, the UR10e remained at its home configuration while available lettuce targets were localized. Each camera-frame target \mathbf{p}_{cut}^{cam} was transformed to the robot frame and corrected for the cut-and-hold tool geometry:

\mathbf{p}^{T}=\mathcal{T}_{cr}\left(\mathbf{p}_{cut}^{cam}\right)+\Delta\mathbf{p}_{d}
(12)

where \mathcal{T}_{cr}(\cdot) denotes the calibrated rigid camera-to-robot transformation and \Delta\mathbf{p}_{d}=[\Delta x_{d},\Delta y_{d},\Delta z_{d}]^{\top} denotes the fixed deployment correction accounting for residual perception, calibration, and end-effector geometry. The correction was determined before the reported evaluation and was subsequently held fixed.

No external sequence of intermediate side-approach waypoints was generated during deployment. Instead, \mathbf{p}^{T} defined the same target-conditioned approach geometry used during training. The arm first moved to the corresponding deterministic safe-start configuration, after which PSA-PPO controlled the final local side approach; \mathbf{p}^{S} therefore remained an internal geometric reference rather than a separately commanded physical waypoint.

During inference, the actor was evaluated deterministically:

\bar{\mathbf{u}}_{t}=\mu_{\theta}\left(\boldsymbol{\xi}_{t}\right),\qquad\mathbf{q}^{ROS}_{cmd,t}=f_{map}\left(\mathbf{q}^{cmd}_{t}\right)
(13)

where \mu_{\theta}(\cdot) is the deterministic actor output, \mathbf{q}^{cmd}_{t} follows Eq. (6), and f_{map}(\cdot) maps the simulation joint ordering to the physical UR10e controller interface.

The ROS interface updated the policy state from UR10e joint feedback and published single-point JointTrajectory commands to the scaled joint-trajectory controller. For each command, feasible per-joint durations were computed from the current state, commanded displacement, and prescribed velocity and acceleration limits, and their maximum was used as the synchronized trajectory duration. Acceleration was checked before command publication and from measured joint-velocity feedback; exceeding the corresponding safety threshold replaced the pending motion with a hold command and entered a halted state. These execution safeguards operated outside the learned task objective.

After the target-reaching condition was satisfied, the harvest controller closed the OnRobot 2FG7 gripper to actuate the cut-and-hold mechanism, transferred the harvested lettuce to the collection basket, and reopened the gripper for release. When multiple targets were available, the remaining target with the smallest Euclidean distance from the current TCP position was selected; otherwise, the robot returned home.

3 Experiment

3.1 Experimental Setup

PSA-PPO training and simulation evaluation were conducted using NVIDIA Isaac Lab in Isaac Sim 5.1.0 with the RSL-RL backend. Training used GPU-parallel simulation on an Ubuntu 22.04 LTS workstation equipped with dual Intel Xeon Gold processors, 256 GB RAM, and an NVIDIA RTX A6000 GPU with 48 GB VRAM. Candidate policies were trained without physical robot interaction, and the selected actor was evaluated deterministically on a fixed set of randomly generated targets spanning the prescribed front workspace. The component-removal ablations were evaluated on the same targets, enabling paired target-wise comparison with the complete PSA-PPO formulation.

Physical experiments used an RB-VOGUI mobile platform (Robotnik Automation, Paterna, Spain) equipped with a UR10e manipulator (Universal Robots, Odense, Denmark), an OnRobot 2FG7 gripper (OnRobot, Odense, Denmark), and an Intel® RealSense™ D435i RGB-D camera mounted near the tool center point. The adapted end effector was mounted directly to the 2FG7, while an onboard Intel i7-based computer executed perception, target transformation, harvesting sequencing, deterministic PSA-PPO inference, ROS 1 communication, and gripper control. The simulation-trained actor was transferred to this platform without any fine-tuning.

Two complementary physical experiments were conducted. First, a controlled motion benchmark compared PSA-PPO with Cartesian+TOTG, RRTConnect, and RRT* over the same scheduled target locations, isolating controller behavior from perception and crop-interaction effects. Second, the complete PSA-PPO system was evaluated on greenhouse lettuce harvesting trials at the Texas A&M AgriLife Research Center in Dallas, TX, USA, where cutting-point targets were generated online by the RGB-D perception module. However, calibration was performed to map the targets between the camera and robot frames. Thus, the greenhouse experiment evaluated the complete vision-to-harvest pipeline. Planner configurations and benchmark implementation details are reported in Appendix C.

3.2 Evaluation Protocol

Table 1: Evaluation protocol used for simulation, controlled physical benchmarking, and greenhouse harvesting.
  • Simulation validation
    Population
    200 workspace targets
    Primary outcomes
    Reaching the target w/o any safety measures, path-safe reaching, strict success, final TCP error, and maximum below-plane violation
  • Formulation ablation
    Population
    Same 200 targets per formulation
    Primary outcomes
    Reach without safety measures, path-safe, and strict success; target-frame behavior, maximum below-plane violation, trajectory length, and episode duration
  • Physical benchmark
    Population
    150 scheduled targets per controller; N=97 common-success targets for continuous comparisons
    Primary outcomes
    Target-reaching reliability, endpoint error, local TCP acceleration and jerk, joint-position tracking error, normalized target convergence, and trajectory geometry
  • Greenhouse harvesting
    Population
    144 harvesting attempts
    Primary outcomes
    Target reaching, cutting, retention, release, and complete harvesting success

Evaluation was organized at three levels: simulation, controlled physical motion, and greenhouse harvesting, with the formulation ablation embedded within the simulation evaluation. Table 1 summarizes the corresponding populations and primary outcomes.

For simulation target k, the terminal TCP error was:

d_{k}^{T}=\left\|\mathbf{p}^{T}_{k}-\mathbf{p}^{tcp}_{k,f}\right\|_{2}
(14)

Let I_{k}^{\mathrm{final}} indicate satisfaction of the final capture criterion over the prescribed validation hold interval, and let I_{k}^{\mathrm{safe}} indicate satisfaction of both the safe-start and learned-path tolerances,

I_{k}^{\mathrm{safe}}=\mathbb{I}\left[b_{0,k}\leq\varepsilon_{\mathrm{safe}}\;\land\;b_{k}^{\max}\leq\varepsilon_{\mathrm{safe}}\right]
(15)

Strict success required both conditions, such that I_{k}^{\mathrm{strict}}=I_{k}^{\mathrm{final}}I_{k}^{\mathrm{safe}}. The corresponding simulation rates were:

R_{r}=\frac{100}{N_{v}}\sum_{k=1}^{N_{v}}I_{k}^{r},\quad r\in\left\{\mathrm{final},\mathrm{safe},\mathrm{strict}\right\}
(16)

For each component-removal formulation a, the paired strict-success loss relative to the complete PSA-PPO formulation was defined over the identical target set as:

\Delta R_{\mathrm{strict}}^{(a)}=\frac{100}{N_{v}}\sum_{k=1}^{N_{v}}\left(I_{k,\mathrm{full}}^{\mathrm{strict}}-I_{k,a}^{\mathrm{strict}}\right)
(17)

Target-frame errors, tool orientation, maximum below-plane violation, trajectory length, episode duration, and motion quantities were retained for the behavioral analyses reported with the ablation results.

Let \mathcal{M}=\{\mathrm{PSA\mbox{-}PPO},\mathrm{Cartesian+TOTG},\mathrm{RRTConnect},\linebreak\mathrm{RRT^{*}}\} denote the set of controllers for the controlled physical benchmark. Physical reaching for target k and controller c was defined by-

I_{k,c}^{\mathrm{reach}}=\mathbb{I}\left[d_{k,c}^{T}\leq\varepsilon_{r}\right],\quad R_{\mathrm{reach}}^{(c)}=\frac{100}{N_{b}}\sum_{k=1}^{N_{b}}I_{k,c}^{\mathrm{reach}}
(18)

where \varepsilon_{r}=0.020 m was the common physical evaluation tolerance. Continuous controller comparisons were restricted to the mutually successful target set:

\mathcal{K}_{\cap}=\bigcap_{c\in\mathcal{M}}\left\{k:I_{k,c}^{\mathrm{reach}}=1\right\},\quad N_{\cap}=\left|\mathcal{K}_{\cap}\right|
(19)

TCP transforms and joint states were recorded at 100 Hz, uniformly resampled, and smoothed using a 0.15-s moving-average window before derivative-based analysis. With a_{i}=\|\mathbf{a}_{i}\|_{2} and j_{i}=\|\mathbf{j}_{i}\|_{2}, motion intensity was quantified by-

A_{\mathrm{rms}}=\sqrt{\frac{1}{N_{a}}\sum_{i=1}^{N_{a}}a_{i}^{2}},\quad J_{\mathrm{rms}}=\sqrt{\frac{1}{N_{j}}\sum_{i=1}^{N_{j}}j_{i}^{2}}
(20)

together with the 99.5th-percentile jerk J_{99.5}. The primary local-motion comparison used the final 0.22 m of target-relative approach. Executed trajectory length and geometric detour were defined as:

L_{\mathrm{path}}=\sum_{m=1}^{M-1}\left\|\mathbf{s}_{m+1}-\mathbf{s}_{m}\right\|_{2},\quad D_{\mathrm{ratio}}=\frac{L_{\mathrm{path}}}{\left\|\mathbf{s}_{M}-\mathbf{s}_{1}\right\|_{2}}
(21)

where D_{\mathrm{ratio}}\geq 1, with values closer to unity indicating more direct motion. Endpoint error, joint-position tracking RMSE, normalized target convergence, and additional trajectory-geometry measures were evaluated from the same paired trajectories. Detailed trajectory processing, planner settings, and benchmark-integrity procedures are provided in Appendix C.

For greenhouse attempt k, harvesting progression was evaluated sequentially through reaching, cutting, retention, and release. If N_{m} denotes the number of attempts completing stage m, the cumulative and conditional stage rates were:

\begin{split}&R_{m}=\frac{N_{m}}{N_{h}}\times 100\%,\quad R_{m\mid m-1}=\frac{N_{m}}{N_{m-1}}\times 100\%\\
&m\in\left\{\mathrm{reach},\mathrm{cut},\mathrm{hold},\mathrm{release}\right\}\end{split}
(22)

where the conditional rate was applied from the cutting stage onward. Because successful release required completion of all preceding stages, overall harvesting success was:

H_{\mathrm{success}}=R_{\mathrm{release}}=\frac{N_{\mathrm{complete}}}{N_{h}}\times 100\%
(23)

Failures were assigned to the first unsuccessful harvesting stage. Paired statistical tests, bootstrap confidence intervals, multiplicity correction, and sensitivity analyses used for the simulation ablation and physical benchmark are detailed in Appendices B and C.

3.3 Results

3.3.1 Simulation Validation and Formulation Ablation
Table 2: Component-removal ablation of PSA-PPO over the same 200 simulation targets. Continuous quantities are reported as median [Q1,Q3].
  • Final reach (%)
    PSA-PPO
    99.0
    w/o path safety
    89.0
    w/o side corridor
    100.0
    w/o motion reg.
    98.0
  • Path-safe (%)
    PSA-PPO
    92.5
    w/o path safety
    69.5
    w/o side corridor
    73.0
    w/o motion reg.
    88.5
  • Strict success (%)
    PSA-PPO
    92.0
    w/o path safety
    63.5
    w/o side corridor
    73.0
    w/o motion reg.
    87.0
  • Final TCP error (mm)
    PSA-PPO
    32.3 [29.2, 35.1]
    w/o path safety
    32.1 [28.3, 38.3]
    w/o side corridor
    25.3 [21.4, 28.6]
    w/o motion reg.
    35.0 [30.5, 39.2]
  • P95 maximum below-plane violation (mm)
    PSA-PPO
    2.11
    w/o path safety
    26.8
    w/o side corridor
    14.3
    w/o motion reg.
    4.52
  • Trajectory length (m)
    PSA-PPO
    0.406 [0.264, 0.547]
    w/o path safety
    0.443 [0.294, 0.567]
    w/o side corridor
    0.461 [0.294, 0.592]
    w/o motion reg.
    0.464 [0.309, 0.592]
  • Duration (s)
    PSA-PPO
    1.47 [0.933, 2.24]
    w/o path safety
    1.13 [0.867, 1.60]
    w/o side corridor
    1.40 [0.967, 2.04]
    w/o motion reg.
    1.52 [1.13, 3.12]
Figure 5: Effect of PSA-PPO component removal on harvesting-compatible simulation performance over the same 200 targets. (a) Final reaching, path-safe reaching, and strict success with Wilson 95% confidence intervals. (b) Empirical distribution of the maximum wrist–TCP below-plane violation; the dashed vertical line denotes the 2-mm strict path-safety threshold.

Simulation validation and component effects. The selected PSA-PPO policy satisfied the final capture criterion for 198 of 200 targets (99.0%), the path-safety criterion for 185 trajectories (92.5%), and both conditions for 184 targets, yielding 92.0% strict success. The 7-percentage-point difference between final reaching and strict success was dominated by trajectory-level clearance: among the 16 strict failures, 14 were safety-only cases, one was a capture-only case, and one failed both criteria. Thus, terminal target acquisition alone did not fully characterize the harvesting-compatible behavior captured by the strict criterion.

The component-removal results in Table 2 show that path-safety shaping had the largest association with strict performance. Removing these terms reduced final reaching from 99.0% to 89.0%, path-safe success from 92.5% to 69.5%, and strict success from 92.0% to 63.5%. On the paired target set, PSA-PPO remained strictly successful for 61 targets on which the no-path-safety formulation failed, whereas the reverse occurred for only four targets. The resulting strict-success difference was 28.5 percentage points (95% CI: 21.5–35.5 percentage points; Holm-adjusted p=1.18\times 10^{-13}). The P95 maximum below-plane violation increased from 2.11 to 26.8 mm, and the largest observed violation increased from 9.68 to 54.3 mm.

Removing the side-corridor terms produced a different trade-off. This formulation reached all 200 targets and achieved a smaller median final TCP error than PSA-PPO (25.3 versus 32.3 mm), yet path-safe and strict success both decreased to 73.0%. The paired strict-success loss was 19.0 percentage points (95% CI: 13.5–25.0 percentage points; Holm-adjusted p=8.22\times 10^{-10}). The result therefore separates terminal precision from the compound harvesting criterion: improved endpoint accuracy did not imply improved path-safe reaching.

Removal of motion regularization produced the smallest task-level effect. Final reaching remained 98.0%, while path-safe and strict success decreased to 88.5% and 87.0%, respectively. The paired strict-success loss was 5.0 percentage points (95% CI: 1.5–8.5 percentage points; Holm-adjusted p=0.0129). However, the corresponding raw-action-rate, action-acceleration, and TCP-jerk diagnostics did not increase monotonically when regularization was removed. The evaluated checkpoint therefore does not support attributing lower jerk directly to the regularization terms; instead, their measurable task-level association was a modest increase in strict success together with a different trajectory-duration trade-off.

Figure 5 provides the corresponding population-level view. In addition to the strict-success degradation, the below plane empirical cumulative distribution function (ECDF) shows that removal of the path-safety formulation substantially increased the upper tail of trajectory-level violation.

Behavioral and workspace robustness. The target-frame profiles in Figure 6 show that the component removals altered different aspects of the local approach rather than uniformly scaling trajectory quality. The clearest separation occurred in the path-safety channel, where the no-path-safety formulation produced substantially larger below-plane excursions. In contrast, the lateral and vertical profiles did not exhibit a consistent ordering across all formulations. This behavior is consistent with the side-corridor terms acting within a coupled target-closure and constraint-shaping objective, rather than as an independent fixed-band controller. All formulations reduced TCP-to-target distance toward the end of the approach, but differed in whether that convergence was achieved while satisfying the complete strict criterion.

Figure 6: Target-frame trajectory profiles for PSA-PPO and the three component-removal formulations over the common 200-target evaluation set: (a) absolute lateral error, (b) absolute vertical error, (c) wrist–TCP below-plane violation, and (d) TCP distance to the target as functions of normalized staging-to-target progress. Curves denote median behavior and shaded regions the corresponding trajectory dispersion.

The workspace analysis in Figure 7 shows that PSA-PPO retained comparatively high strict success across the evaluated radius, azimuth, and height bins, whereas removal of the path-safety or side-corridor terms produced larger degradation in several regions of the workspace. The motion-regularization formulation remained closer to PSA-PPO throughout most bins, consistent with its smaller aggregate strict-success difference.

Figure 7: Strict-success performance of PSA-PPO and the three component-removal formulations across common bins of target radius, target azimuth, and target height (left to right). The bin-wise results characterize variation over the evaluated target set for the selected checkpoints and not variability across independent policy retraining.

Taken together, the simulation results identify path-safety shaping as the largest task-level contributor among the tested removals and show that side-corridor shaping can improve strict harvesting-compatible performance even when terminal accuracy alone improves after its removal. Detailed paired outcomes, fixed-band corridor diagnostics, orientation and motion-regularization analyses, three-dimensional workspace maps, and representative trajectories are provided in Appendix B. Because one independently trained checkpoint was evaluated per formulation, these comparisons characterize the evaluated policies over the common target set and do not quantify retraining variability.

3.3.2 PSA-PPO vs. Classical Motion Planners on the Physical Robot

Task-level reliability, terminal precision, and failure behavior. PSA-PPO achieved the highest observed target-reaching rate, successfully reaching 142 of 150 targets (94.7%), compared with 132/150 (88.0%) for RRTConnect, 129/150 (86.0%) for Cartesian+TOTG, and 120/150 (80.0%) for RRT* (Table 3). Thus, the simulation-trained policy retained high task-level reliability after transfer to the physical UR10e.

Table 3: Physical target-reaching reliability of PSA-PPO and the classical planning baselines under the common 20-mm reaching criterion. Here, CI denotes the confidence interval.
  • PSA-PPO
    Reached
    142/150
    Failed
    8
    Success (%) [95% CI]
    94.7 [89.8, 97.3]
  • Cartesian+TOTG
    Reached
    129/150
    Failed
    21
    Success (%) [95% CI]
    86.0 [79.5, 90.7]
  • RRTConnect
    Reached
    132/150
    Failed
    18
    Success (%) [95% CI]
    88.0 [81.8, 92.3]
  • RRT*
    Reached
    120/150
    Failed
    30
    Success (%) [95% CI]
    80.0 [72.9, 85.6]

On the common-success targets, the median final TCP error was 9.78 mm for PSA-PPO, compared with 0.06 mm for Cartesian+TOTG, 1.62 mm for RRTConnect, and 1.61 mm for RRT*. The endpoint ECDF in Figure 8 shows this separation across the distribution. The classical planners therefore retained a substantial advantage in terminal positioning precision, while the PSA-PPO median remained below one-half of the 20-mm task-level tolerance. However, while the planner-based approach struggled to reach all targets, PSA-PPO outperformed it by 94.7%, achieving success while maintaining all safety criteria.

Figure 8: Empirical cumulative distribution of physical TCP endpoint error. The vertical dashed line denotes the 20-mm reaching criterion. Planner-based control produced tighter endpoint distributions, whereas PSA-PPO exhibited a broader but predominantly tolerance-compliant distribution.

Failure diagnostics further distinguish the controllers beyond their binary success rates. PSA-PPO unsuccessful runs were concentrated more strongly in target-reaching events, whereas the planner executions exhibited a broader mixture of planning-, execution-, return-, and controller-related diagnostic events (Figure 9). Because these event categories were not mutually exclusive, the figure is interpreted independently of the unique unsuccessful-target counts in Table 3.

Figure 9: Recorded failure-related events during the physical controller benchmark. Cell counts denote diagnostic events and are not necessarily mutually exclusive; the corresponding numbers of unique unsuccessful targets were 8 for PSA-PPO, 21 for Cartesian+TOTG, 18 for RRTConnect, and 30 for RRT*.

Local motion dynamics and target convergence. Within the final 0.22-m target-relative approach, PSA-PPO produced median RMS acceleration and jerk of 0.127 m/s2 and 11.38 m/s3, respectively, compared with 0.528 and 42.17 for Cartesian+TOTG, 0.555 and 40.74 for RRTConnect, and 0.267 and 18.91 for RRT* (Table 4). Relative to the planner medians, the PSA-PPO reductions in RMS jerk were 73.0%, 72.1%, and 39.8%. The corresponding reductions in RMS acceleration were 75.9%, 77.1%, and 52.4%. High-end transients followed the same ordering: the 99.5th-percentile jerk was 77.72 m/s3 for PSA-PPO versus 131.88, 164.77, and 127.84 m/s3, respectively. Joint-position tracking RMSE was also lowest for PSA-PPO. All PSA-PPO–planner paired contrasts for the four local-motion metrics remained significant after Holm correction (adjusted p=4.02\times 10^{-16}).

Table 4: Physical motion quality within the final 0.22-m target-relative approach. Values are medians over the common-success target set (N=97). Lower values indicate lower dynamic excitation or tracking error.
  • RMS acceleration (m/s2)
    PSA-PPO
    0.1270
    Cartesian+TOTG
    0.5277
    RRTConnect
    0.5549
    RRT*
    0.2668
  • RMS jerk (m/s3)
    PSA-PPO
    11.38
    Cartesian+TOTG
    42.17
    RRTConnect
    40.74
    RRT*
    18.91
  • 99.5th-percentile jerk (m/s3)
    PSA-PPO
    77.72
    Cartesian+TOTG
    131.88
    RRTConnect
    164.77
    RRT*
    127.84
  • Joint-position tracking RMSE (rad)
    PSA-PPO
    \boldsymbol{6.96\times 10^{-4}}
    Cartesian+TOTG
    2.56\times 10^{-3}
    RRTConnect
    2.47\times 10^{-3}
    RRT*
    1.15\times 10^{-3}

The normalized motion profiles in Figure 10 show that the lower aggregate PSA-PPO acceleration and jerk were sustained over substantial portions of the local approach rather than arising solely from isolated endpoints. The perpendicular-deviation profiles, however, overlap more strongly across controllers. Lower dynamic excitation should therefore not be interpreted as evidence that PSA-PPO followed the most geometrically direct Cartesian path.

Figure 10: Measured trajectory profiles for the four physical controllers over the common-success target population: (a) TCP speed, (b) acceleration, (c) jerk over normalized active approach progression, and (d) perpendicular deviation from the start–target reference line over normalized longitudinal progress. The normalized axes describe trajectory progression rather than absolute wall-clock execution time.

Target-distance contraction also differed across controllers. PSA-PPO reduced the remaining target distance to 50% of its local-window entry value after a median normalized progression of 0.195, compared with 0.405 for Cartesian+TOTG, 0.370 for RRTConnect, and 0.345 for RRT* (Figure 11). PSA-PPO therefore performed a larger fraction of its target closure earlier in its own normalized local approach. This quantity characterizes convergence shape and does not represent wall-clock execution speed.

Figure 11: Normalized target-distance contraction during the final 0.22-m approach over the common-success target set. Remaining TCP-to-target distance is normalized by its value at local-window entry, while the horizontal axis represents each trajectory’s normalized active progression. PSA-PPO reached 50% remaining distance earlier in normalized progression than the three planner-based controllers.

Trajectory geometry and controller trade-off. Lower PSA-PPO dynamic excitation did not correspond to shorter or more direct paths. Over the complete reconstructed approach, the median detour ratio was 1.81 for PSA-PPO, compared with 1.67 for Cartesian+TOTG, 1.68 for RRTConnect, and 1.70 for RRT*. PSA-PPO also accumulated greater total joint travel than the planner-based methods. The population-level geometry therefore favored the classical planners in path directness, while the physical motion-quality results favored PSA-PPO in acceleration, jerk, and tracking error. Detailed trajectory-geometry statistics, reliability geometry trade-offs, and matched examples of atypically expansive planner trajectories are provided in Appendix C.

Overall, the physical benchmark reveals a controller trade-off rather than uniform dominance: the classical planners achieved substantially greater terminal precision and more direct average trajectories, whereas PSA-PPO achieved the highest observed reaching rate together with markedly lower local dynamic excitation and joint-tracking error.

3.3.3 Target-Reaching Performance in Harvesting

The end-effector of the integrated system successfully reached 136 out of 144 vision-derived lettuce cutting points, achieving a target success rate of 94.4% in the greenhouse (Table 5). Cutting was completed successfully for 124 plants, which accounts for 86.1% of all attempts after reaching the target. Additionally, we noted that 13 plants were not properly secured after cutting, and 3 plants fell during transfer to the basket.

Table 5: Stage-wise performance of the integrated robotic lettuce harvesting system under greenhouse conditions.
  • Target reached
    Successful
    136/144
    Overall (%)
    94.4
    Conditional (%)
    94.4
  • Lettuce cut
    Successful
    124/144
    Overall (%)
    86.1
    Conditional (%)
    91.2

However, the conditional rates reveal that the most harvesting failures occur after target acquisition. Cutting succeeded for 124 of the 136 reached plants, resulting in a success rate of 91.2%. Retention succeeded for 111 of 124 cut plants (89.5%), and basket release succeeded for 108 of 111 retained plants, achieving a success rate of 97.3%. Therefore, the principal loss in complete-system performance occurred during physical interaction between the crop and the end-effector, rather than motion policy control.

Figure 12: Representative online target stream during greenhouse harvesting. The image was acquired from the robot-mounted RGB-D camera while the UR10e remained at the home configuration. The vision node identified the available lettuce targets and published their corresponding 3D cutting-point coordinates for subsequent robot-frame transformation and target-conditioned reaching.

Figure 12 shows the online target stream generated by the vision module, while Figure 13 depicts a typical execution of the resulting physical sequence: PSA-PPO performed the vision-conditioned side approach, closure of the 2FG7-actuated cutting and retention, and the retained lettuce was subsequently transferred and released into the collection basket.

Figure 13: Representative greenhouse execution of the integrated harvesting pipeline: (a) PSA-PPO-controlled side approach toward the vision-derived cutting location; (b) simultaneous cutting and retention using the 2FG7-driven cut-and-hold end effector; and (c) release of the harvested lettuce into the collection basket.

The greenhouse evaluation therefore shows that the simulation-trained PSA-PPO controller retained a high reaching rate when driven by online RGB-D targets within the complete harvesting system, while the principal remaining performance losses occurred downstream during cutting and retention.

3.4 Discussion

The simulation results indicate that the main value of the PSA-PPO formulation lies in how harvesting-compatible success is structured rather than in terminal reaching alone. Removing the path-safety terms produced the largest degradation in strict success and substantially increased the tail of below-plane violations, confirming that transient trajectory behavior can remain unacceptable even when the final target is reached. The side-corridor ablation provides an equally important counter-example: it improved terminal accuracy and reached every target, yet reduced strict success considerably. Thus, optimization toward the endpoint alone can produce a numerically better reaching result while weakening the combined harvesting constraint. The motion-regularization ablation was less conclusive; although its removal reduced strict success, several action- and TCP-derivative measures did not worsen. The present evidence therefore supports path-safety and corridor shaping as important elements of the coupled task formulation, but does not justify attributing lower jerk directly to the regularization term. This task-structured use of simulation-trained control is related to recent plant-manipulation work by Subedi et al. [33], who separated structured kinematic motion from a policy learned entirely in simulation; however, their objective was occlusion removal rather than harvesting-compatible crop-proximal reaching. Moreover, because one independently trained checkpoint was evaluated per formulation, the ablation establishes differences over the common target set rather than retraining robustness.

The physical benchmark provides stronger evidence for transfer, while also revealing a clear learned-versus-planned trade-off. PSA-PPO achieved the highest reaching reliability and substantially lower local acceleration, jerk, and joint-tracking error, but the classical planners retained markedly better endpoint precision and more direct trajectories. These results are therefore complementary rather than hierarchical: PSA-PPO occupied a favorable reliability–dynamic-excitation regime, whereas the planners remained stronger in geometric precision and path efficiency. Figure 14 visualizes this trade-off directly. Recent agricultural planning work illustrates the value of that geometric objective; for example, Kang et al. [15] explicitly optimized planning time, path length, and trajectory smoothness for selective broccoli harvesting. The present results therefore do not suggest replacing geometric planning where path optimality is primary, but rather identify a different operating regime for learned crop-proximal motion. This distinction is especially relevant near crops and rigid cultivation infrastructure, where smooth execution is desirable, but lower jerk is not itself evidence of collision safety. Similarly, occasional expansive planner trajectories should not override the population-level finding that their paths were more direct on average. The measured physical dynamics must also be interpreted as properties of the deployed controller stack, because PSA-PPO inference was combined with action filtering and an independent hardware safety wrapper rather than executed as an isolated learned policy.

Figure 14: Physical controller trade-offs between target-reaching reliability and (a) median RMS jerk within the final 0.22-m approach and (b) median trajectory detour ratio. PSA-PPO favors the reliability–dynamic-excitation operating regime, whereas the planner-based controllers retain greater geometric directness.

The jerk reduction achieved by PSA-PPO relative to the classical planners has two separable contributors that should be distinguished. First, the deployment stack applies a temporal action filter (\alpha=0.18) and an independent hardware acceleration safeguard (0.0045 rad/s^{2}) that attenuate high-frequency motion regardless of policy behavior; these are stack-level properties rather than learned ones, and their individual contribution to the observed jerk advantage cannot be isolated without a dedicated ablation. Second, Figure 10 shows that lower acceleration and jerk are sustained over the full local approach rather than at isolated endpoints, consistent with the policy having learned intrinsically smoother convergence as an emergent property of the coupled task formulation. The motion-regularization ablation does not support attributing this smoothness directly to the regularization reward terms, since their removal did not produce a monotonic increase in raw-action diagnostics (Figure 5(b)). Fully disaggregating these two contributors is left for future work.

The greenhouse experiment shifts the interpretation from controller behavior to system bottlenecks. Reaching remained high when predefined Cartesian targets were replaced by online RGB-D cutting points, suggesting that the sim-to-real policy did not undergo a large degradation after integration with perception, coordinate transformation, and greenhouse variability. The controlled and greenhouse populations are different; however, their similar reaching rates should not be treated as evidence of statistical equivalence. More importantly, incomplete harvests occurred after successful target reaching. The dominant residual losses therefore moved downstream to tool and crop interaction rather than target acquisition or basket release. This result both supports the usefulness of the learned motion controller and limits its system-level significance: improving reaching alone is unlikely to raise complete harvesting success substantially unless crop interaction is improved concurrently. Recent compliant-control work points to the same systems issue from a different direction; Wang et al. [38] used adaptive variable impedance control and force sensing to regulate physical crop interaction during dragon-fruit picking. For the present system, this suggests that contact-aware control and retention mechanics may now offer greater system-level benefit than further reduction of terminal reaching error alone. Similar stage-dependent losses have also been observed in field-tested harvesting systems [2].

Several limitations consequently define the scope of the present findings. The term “path-safe” refers to the implementation with side-corridor entry, collision avoidance with wrist–TCP target-height clearance criteria, and does not provide formal uncertainty-awareness guarantees for the complete robot or greenhouse scene. The physical study used one manipulator, one greenhouse environment, a frozen policy deployment correction, and a single trained policy for each formulation. Consequently, the reported results characterize the evaluated policies but do not quantify variability across independent training runs. Broader claims therefore require repeated training seeds, additional robot and crop configurations, and evaluation under changing canopy and infrastructure geometry. In addition, the planner baselines were evaluated only in the controlled reaching benchmark and not as complete vision-to-harvest systems, while the perception and cutting modules were inherited from earlier work rather than independently re-evaluated here. Future research will investigate hybrid planning and control architectures that combine global scene-aware planning, learned crop-proximal control, and contact-aware crop interaction. Such a hybrid design could preserve the planners’ geometric strengths while exploiting the reliability and lower local dynamic excitation observed for PSA-PPO.

4 Conclusion

This study formulated robotic lettuce harvesting as a target-conditioned, path-safe, side-corridor approach problem and developed PSA-PPO for simulation training and physical deployment on a UR10e robot. PSA-PPO demonstrated that such a harvesting-specific policy can be optimized entirely in simulation and transferred to a physical robot without real-world policy fine-tuning. The formulation ablation further showed that terminal accuracy alone is an incomplete measure of harvesting-compatible motion: path-safety and side-approach constraints materially affected strict task performance even when endpoint reaching remained high. On the physical robot, PSA-PPO achieved the highest reaching reliability (94.7%) and lower local dynamic excitation, while the classical planners retained advantages in terminal precision but remained unreliable in constrained conditions. The resulting contribution is therefore not universal controller superiority, but a distinct and practically useful operating regime for crop-proximal manipulation. Future work will integrate global geometric planning, learned crop-proximal control, explicit clearance modeling, and contact-aware feedback, while expanding validation across crop conditions and greenhouse environments.

Code Availability

The source code and supporting materials will be made available upon publication at https://github.com/bashir-tamu/PSA-PPO-Lettuce-Harvesting.

Acknowledgments

This research is partially supported by the United States Department of Agriculture (USDA)’s National Institute of Food and Agriculture (NIFA) Research Capacity Fund Hatch Program: TEX09954 (Accession No. 7002248) and Research Capacity Fund Multistate Hatch Program: TEX0-1-9916 (Accession No. 7008389). This publication is also supported by the Texas A&M University Division of Research Targeted Proposal Teams (TPT) funding program and Texas A&M AgriLife Research. Any opinions, findings, conclusions, or recommendations expressed in this publication are those of the authors and should not be construed to represent any official USDA or U.S. Government determination or policy.

References

  1. [1] J. Achiam, D. Held, A. Tamar, and P. Abbeel (2017) Constrained policy optimization. In Proceedings of the 34th International Conference on Machine Learning, Proceedings of Machine Learning Research, Vol. 70, pp. 22–31.
  2. [2] B. Arad, J. Balendonck, R. Barth, O. Ben-Shahar, Y. Edan, T. Hellström, J. Hemming, P. Kurtser, O. Ringdahl, T. Tielen, and B. van Tuijl (2020) Development of a sweet pepper harvesting robot. Journal of Field Robotics 37 (6), pp. 1027–1039. External Links: Document
  3. [3] A. Bashir, Y. Majeed, and A. Zahid (2025) Development of an end-effector for robotic harvesting of hydroponic lettuce. Journal of the ASABE 68 (4), pp. 645–657. External Links: Document
  4. [4] A. Bashir, Y. Wang, M. O. Ojo, and A. Zahid (2026) A vision system for occluded cutting point localization in robotic harvesting of greenhouse lettuce. IEEE Transactions on AgriFood Electronics 4 (1), pp. 157–167. External Links: Document
  5. [5] S. Birrell, J. Hughes, J. Y. Cai, and F. Iida (2020) A field-tested robotic harvesting system for iceberg lettuce. Journal of Field Robotics 37 (2), pp. 225–245. External Links: Document
  6. [6] F. Chaumette and S. Hutchinson (2006) Visual servo control, part i: basic approaches. IEEE Robotics & Automation Magazine 13 (4), pp. 82–90.
  7. [7] S. I. Cho, S. J. Chang, Y. Kim, and K. J. An (2002) Development of a three-degrees-of-freedom robot for harvesting lettuce using machine vision and fuzzy logic control. Biosystems Engineering 82 (2), pp. 143–149. External Links: Document
  8. [8] G. Dulac-Arnold, N. Levine, D. J. Mankowitz, J. Li, C. Paduraru, S. Gowal, and T. Hester (2021) Challenges of real-world reinforcement learning: definitions, benchmarks and analysis. Machine Learning 110 (9), pp. 2419–2468. External Links: Document
  9. [9] L. He, Y. Sun, L. Chen, Q. Feng, Y. Li, J. Lin, Y. Qiao, and C. Zhao (2025) Advance on agricultural robot hand–eye coordination for agronomic task: a review. Engineering 51, pp. 263–279. External Links: Document
  10. [10] H. A. Hernández, I. F. Mondragón, S. R. González, and L. F. Pedraza (2025) Reconfigurable agricultural robotics: control strategies, communication, and applications. Computers and Electronics in Agriculture 234, pp. 110161. External Links: Document
  11. [11] A. Huang, C. Yu, J. Feng, X. Tong, A. Yorozu, A. Ohya, and Y. Hu (2025) A motion planning method for winter jujube harvesting robotic arm based on optimized informed-rrt* algorithm. Smart Agricultural Technology 10, pp. 100732. External Links: Document
  12. [12] Z. Huang, D. Yang, Z. Cheng, and X. Jiang (2025) Towards autonomous premium tea harvesting: a high-efficiency and high-quality path planning based on optimized iabfmt* algorithm in unstructured canopies. Smart Agricultural Technology 12, pp. 101317. External Links: Document
  13. [13] Z. Huang, C. Chen, N. Ikegaya, T. Chang, K. Ke, and Y. Chen (2026) A robotic harvesting system for occluded cucumbers using f2sa-yolov8 and hvsc. Computers and Electronics in Agriculture 246, pp. 111616. External Links: Document
  14. [14] T. Jin and X. Han (2024) Robotic arms in precision agriculture: a comprehensive review of the technologies, applications, challenges, and future prospects. Computers and Electronics in Agriculture 221, pp. 108938. External Links: Document
  15. [15] S. Kang, D. Li, S. Long, Y. Ye, F. Kuang, D. Du, and J. Wang (2025) Time-optimal and path-optimal motion planning for selective broccoli harvesting manipulator. Computers and Electronics in Agriculture 239, pp. 111007. External Links: Document
  16. [16] S. Karaman and E. Frazzoli (2011) Sampling-based algorithms for optimal motion planning. The International Journal of Robotics Research 30 (7), pp. 846–894. External Links: Document
  17. [17] C. H. Kim, A. Silwal, and G. Kantor (2025) Autonomous robotic pepper harvesting: imitation learning in unstructured agricultural environments. IEEE Robotics and Automation Letters 10 (4), pp. 3406–3413. External Links: Document
  18. [18] T. Kunz and M. Stilman (2012) Time-optimal trajectory generation for path following with bounded acceleration and velocity. In Proceedings of Robotics: Science and Systems, pp. 1–8. External Links: Document
  19. [19] S. Levine, P. Pastor, A. Krizhevsky, J. Ibarz, and D. Quillen (2018) Learning hand-eye coordination for robotic grasping with deep learning and large-scale data collection. The International journal of robotics research 37 (4-5), pp. 421–436. External Links: Document
  20. [20] X. Li, K. Hsu, J. Gu, O. Mees, K. Pertsch, H. R. Walke, C. Fu, I. Lunawat, I. Sieh, S. Kirmani, S. Levine, J. Wu, C. Finn, H. Su, Q. Vuong, and T. Xiao (2025) Evaluating real-world robot manipulation policies in simulation. In Proceedings of the 8th Conference on Robot Learning, Proceedings of Machine Learning Research, Vol. 270, pp. 3705–3728.
  21. [21] L. Liu, F. Yang, X. Liu, Y. Du, X. Li, G. Li, D. Chen, Z. Zhu, and Z. Song (2024) A review of the current status and common key technologies for agricultural field robots. Computers and Electronics in Agriculture 227, pp. 109630. External Links: Document
  22. [22] P. Ma, A. Zhu, Y. Chen, Y. Tu, H. Mao, J. Song, X. Wang, S. Su, D. Li, and X. Dong (2024) Multi objective motion planning of fruit harvesting manipulator based on improved bit* algorithm. Computers and Electronics in Agriculture 227, pp. 109567. External Links: Document
  23. [23] P. Malvido Fresnillo, S. Vasudevan, W. M. Mohammed, J. L. Martinez Lastra, and J. A. Perez Garcia (2023) Extending the motion planning framework—moveit with advanced manipulation functions for industrial applications. Robotics and Computer-Integrated Manufacturing 83, pp. 102559. External Links: Document
  24. [24] M. Mittal et al. (2025) Isaac lab: a gpu-accelerated simulation framework for multi-modal robot learning. arXiv preprint arXiv:2511.04831.
  25. [25] Y. Park, J. Seol, J. Pak, Y. Jo, C. Kim, and H. I. Son (2023) Human-centered approach for an efficient cucumber harvesting robot system: harvest ordering, visual servoing, and end-effector. Computers and Electronics in Agriculture 212, pp. 108116. External Links: Document
  26. [26] X. B. Peng, M. Andrychowicz, W. Zaremba, and P. Abbeel (2018) Sim-to-real transfer of robotic control with dynamics randomization. In IEEE International Conference on Robotics and Automation, pp. 3803–3810. External Links: Document
  27. [27] V. Rajendran, B. Debnath, S. Mghames, W. Mandil, S. Parsa, S. Parsons, and A. Ghalamzan-E (2024) Towards autonomous selective harvesting: a review of robot perception, robot design, motion planning and control. Journal of Field Robotics 41 (7), pp. 2247–2279. External Links: Document
  28. [28] V. Rajendran, B. Debnath, S. Mghames, W. Mandil, S. Parsa, S. Parsons, and A. Ghalamzan-E. (2024) Towards autonomous selective harvesting: a review of robot perception, robot design, motion planning and control. Journal of Field Robotics 41 (7), pp. 2247–2279. External Links: Document
  29. [29] J. Rong, Y. Liu, X. Li, C. Gao, P. Wang, T. Yuan, and W. Li (2025) Decoupled motion planning method for 7-dof manipulator and lifting joint in automated tomato harvesting. Computers and Electronics in Agriculture 237, pp. 110693. External Links: Document
  30. [30] J. Rong, Z. Xiong, C. Xue, J. Yuan, C. Zhang, P. Wang, T. Yuan, and W. Li (2026) Field validation of vision-guided action policy generation for robotic tomato harvesting. Information Processing in Agriculture. External Links: Document
  31. [31] J. Schulman, F. Wolski, P. Dhariwal, A. Radford, and O. Klimov (2017) Proximal policy optimization algorithms. arXiv preprint arXiv:1707.06347.
  32. [32] N. Sobanbabu, G. He, T. He, Y. Yang, and G. Shi (2025) Sampling-based system identification with active exploration for legged sim2real learning. In Proceedings of the 9th Conference on Robot Learning, Proceedings of Machine Learning Research, Vol. 305, pp. 578–598. External Links: Link
  33. [33] N. Subedi, H. Yang, D. K. Jha, S. Sarkar, and A. Raghunathan (2026) Find the Fruit: Zero-Shot Sim2Real RL for Occlusion-Aware Plant Manipulation. In IEEE International Conference on Robotics and Automation (ICRA), pp. 0–0. External Links: Link
  34. [34] I. A. Şucan, M. Moll, and L. E. Kavraki (2012) The open motion planning library. IEEE Robotics & Automation Magazine 19 (4), pp. 72–82. External Links: Document
  35. [35] C. Tang, B. Abbatematteo, J. Hu, R. Chandra, R. Martín-Martín, and P. Stone (2025) Deep reinforcement learning for robotics: a survey of real-world successes. Annual Review of Control, Robotics, and Autonomous Systems 8, pp. 153–188. External Links: Document
  36. [36] J. Tobin, R. Fong, A. Ray, J. Schneider, W. Zaremba, and P. Abbeel (2017) Domain randomization for transferring deep neural networks from simulation to the real world. In IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 23–30. External Links: Document
  37. [37] E.J. van Henten, C.W. Bac, J. Hemming, and Y. Edan (2013) Robotics in protected cultivation. IFAC Proceedings Volumes 46 (18), pp. 170–177. Note: 4th IFAC Conference on Modelling and Control in Agriculture, Horticulture and Post Harvest Industry External Links: ISSN 1474-6670, Document
  38. [38] Z. Wang, K. Lou, B. Zhang, Y. Gu, Q. Xu, and W. Fu (2025) Compliant picking control of dragon fruit picking robot based on adaptive variable impedance. Biosystems Engineering 252, pp. 126–143. External Links: ISSN 1537-5110, Document
  39. [39] T. Yu and H. Jiang (2026) Toward sustainable urban agriculture: development of a robotic end effector for hydroponic lettuce in-situ harvesting in vertical farming. Biosystems Engineering 262, pp. 104362. External Links: ISSN 1537-5110, Document
  40. [40] T. Yu and H. Jiang (2026) Toward sustainable urban agriculture: development of a robotic end effector for hydroponic lettuce in-situ harvesting in vertical farming. Biosystems Engineering 262, pp. 104362. External Links: Document
  41. [41] J. Zhao, Y. Yu, G. Wu, L. Chen, and Q. Zhu (2026) Path planning for agricultural harvesting manipulators under environmental uncertainty: optimization objectives, engineering trade-offs, and learning-based adaptation. Smart Agricultural Technology 14, pp. 102418. External Links: Document

Appendix

Appendix A PSA-PPO Training and Task Configuration

This appendix reports the numerical task and optimization settings used for the final PSA-PPO policy. PSA-PPO used the standard clipped PPO update; the name denotes the harvesting-specific initialization, observation, reward, and strict-success formulation under which the policy was trained. The interaction and success thresholds are listed in Table A.1, the training workspace and target-conditioned safe-start rule in Table A.2, the implemented reward terms in Table A.3, and the PPO/network settings in Table A.5.

Table A.1: Policy interaction, action-processing, capture, and path-safety parameters.
  • Observation dimension
    Value
    42
    Definition
    Policy input dimension
  • Action dimension
    Value
    6
    Definition
    UR10e joint-space action dimension
  • Simulation step
    Value
    1/120 s
    Definition
    Physics integration step
  • Control decimation
    Value
    4
    Definition
    Physics steps per policy action
  • Policy frequency
    Value
    30 Hz
    Definition
    Effective policy rate
  • Episode limit
    Value
    9.0 s
    Definition
    Maximum training episode duration
  • TCP offset
    Value
    0.120 m
    Definition
    Tool offset along local +Z
  • Action filter \alpha
    Value
    0.18
    Definition
    Temporal filter coefficient
  • Action scale s_{u}
    Value
    0.065
    Definition
    Joint-position increment scale
  • \varepsilon_{ax}
    Value
    0.035 m
    Definition
    Axial capture tolerance
  • \varepsilon_{lat}
    Value
    0.030 m
    Definition
    Lateral capture tolerance
  • \varepsilon_{z}
    Value
    0.025 m
    Definition
    Vertical capture tolerance
  • \varepsilon_{d}
    Value
    0.045 m
    Definition
    Euclidean target-distance tolerance
  • \varepsilon_{a}
    Value
    0.95
    Definition
    Minimum approach-axis alignment
  • \varepsilon_{v}
    Value
    0.12
    Definition
    Maximum vertical tool-axis component
  • Vertical soft threshold
    Value
    0.085
    Definition
    Soft orientation-penalty threshold
  • Safety-plane margin
    Value
    0 m
    Definition
    Plane placed at target height
  • \varepsilon_{safe}
    Value
    0.002 m
    Definition
    Maximum strict trajectory violation
  • \varepsilon_{hard}
    Value
    0.050 m
    Definition
    Early-termination violation threshold
  • N_{s}
    Value
    8
    Definition
    Consecutive strict-capture steps
  • Final lateral band
    Value
    0.025 m
    Definition
    Lateral corridor tolerance
  • Final vertical band
    Value
    0.020 m
    Definition
    Vertical corridor tolerance
  • Final line band
    Value
    0.035 m
    Definition
    Perpendicular line tolerance
  • Staging radius
    Value
    0.090 m
    Definition
    Staging-neighborhood threshold
  • Corridor-state progress
    Value
    -0.05
    Definition
    Binary corridor-state threshold

The nominal target-conditioned safe-start posture was constructed from the home configuration \mathbf{q}^{home} and a geometry-dependent posture \mathbf{q}^{geo},

\begin{split}&\mathbf{q}^{ss}=(1-\beta)\mathbf{q}^{home}+\beta\mathbf{q}^{geo},\\
&\mathbf{q}^{home}=[-0.24,-1.57,1.57,0,1.57,0]^{\top}\end{split}
(A.1)

where all joint angles are in radians and \beta was selected from the target geometry. With target azimuth \phi=\operatorname{atan2}(p_{y}^{T},p_{x}^{T}) in radians and z_{n}=\operatorname{clip}((p_{z}^{T}-0.59)/0.10,-1,1), the unblended posture was:

\mathbf{q}^{geo}=\begin{bmatrix}\operatorname{clip}(-0.10+0.70\phi,-1.15,1.15)\\
-1.18-0.10z_{n}+\delta_{s}\\
1.24-0.04z_{n}+\delta_{e}\\
0.05\\
1.57\\
0\end{bmatrix}
(A.2)

During training, an independent uniform perturbation in [-0.004,0.004] rad was added to each joint after construction of the nominal safe-start posture. Thus, the pre-positioning rule itself was target-determined, while a small reset perturbation was retained during policy training.

Table A.2: Training-workspace sampling and target-conditioned safe-start configuration.
  • Training-target distribution
    Value
    无数据
    Implementation
    无数据
  • Target radius
    Value
    [0.60,1.25] m
    Implementation
    Horizontal front-workspace radius
  • Target azimuth
    Value
    [-85^{\circ},85^{\circ}]
    Implementation
    Front-workspace azimuth
  • Target height
    Value
    [0.50,0.68] m
    Implementation
    Vertical target range
  • Approach distance d_{a}
    Value
    [0.18,0.28] m
    Implementation
    Same-height staging-to-target distance
  • Base radial sampling
    Value
    Area-uniform
    Implementation
    \rho=\sqrt{\rho_{min}^{2}+u(\rho_{max}^{2}-\rho_{min}^{2})}
  • Hard-region probability
    Value
    0.55
    Implementation
    A sampled target was reassigned to one of five hard-region modes with equal mode selection probability
  • Far-radius mode
    Value
    [1.08,1.25] m
    Implementation
    Increased far-reach exposure
  • Negative-side mode
    Value
    \rho\in[1.08,1.25] m, \phi\in[-85^{\circ},-25^{\circ}]
    Implementation
    Increased negative-lateral/corner exposure
  • Low-height mode
    Value
    \rho\in[0.90,1.25] m, z\in[0.50,0.585] m
    Implementation
    Increased low/far exposure
  • High-height mode
    Value
    \rho\in[1.08,1.25] m, z\in[0.635,0.68] m
    Implementation
    Increased high/far exposure
  • Side-boundary mode
    Value
    |\phi|\in[55^{\circ},85^{\circ}]
    Implementation
    Increased left/right side-boundary exposure
  • Geometry-aware safe-start selector
    Value
    无数据
    Implementation
    无数据
  • Base blend \beta
    Value
    0.82
    Implementation
    Default blend in Eq. (A.1)
  • Low-height rule
    Value
    z\leq 0.58 m \Rightarrow\beta=0.76
    Implementation
    Overrides stronger blending for low targets
  • Far-radius rule
    Value
    \rho\geq 1.10 m \Rightarrow\beta\geq 0.88
    Implementation
    Applied only when the low-height rule is inactive
  • Very-far rule
    Value
    \rho\geq 1.20 m \Rightarrow\beta\geq 0.92
    Implementation
    Applied only when the low-height rule is inactive
  • Negative/high rule
    Value
    p_{y}^{T}\leq-0.50 m and z\geq 0.64 m \Rightarrow\beta\geq 0.92
    Implementation
    Additional negative-side/high-target blend
  • Far-negative/high rule
    Value
    p_{y}^{T}\leq-0.65 m and z\geq 0.64 m \Rightarrow\beta\geq 0.95
    Implementation
    Strongest blend rule
  • Blend clamp
    Value
    [0.70,0.98]
    Implementation
    Final admissible blend interval
  • Far-radius posture offset
    Value
    (\delta_{s},\delta_{e})=(+0.02,-0.03) rad
    Implementation
    Shoulder/elbow offset for \rho\geq 1.10 m
  • Far-negative/high offset
    Value
    (\delta_{s},\delta_{e})=(+0.04,-0.04) rad
    Implementation
    Overrides the far-radius offset in the far-negative/high region
  • Training reset perturbation
    Value
    \pm 0.004 rad/joint
    Implementation
    Uniform perturbation applied after nominal safe-start construction
Table A.3: Implementation-level reward terms used for the final PSA-PPO policy. The component symbols correspond to the compact decomposition in the main text.
  • \mathcal{R}_{t}^{tar}
    Implemented term
    Staging-distance progress; staging distance
    Weight
    +25;\;-10
    Definition / activation
    Multiplied by 1-\sigma(14(\ell_{t}-0.02))
  • \mathcal{R}_{t}^{tar}
    Implemented term
    Target-distance progress; axial-error progress; line-progress increment; clipped line progress
    Weight
    +720;\;+610;\;+360;\;+185
    Definition / activation
    Distance/axial increments clipped to \pm 0.04; line increment to \pm 0.05; direct \ell_{t} term clipped to [-0.3,1]
  • \mathcal{R}_{t}^{tar}
    Implemented term
    \exp(-7d_{t}^{T}); target shells at d_{t}^{T}<0.15,0.10,0.07 m
    Weight
    +145;\;+105;\;+165;\;+260
    Definition / activation
    Near-target shaping
  • \mathcal{R}_{t}^{tar}
    Implemented term
    Stop-short; staging loiter; target distance; |e_{t}^{ax}|; |e_{t}^{lat}|; |e_{t}^{z}|; axial overshoot
    Weight
    -950;\;-260;\;-190;\;-150; -180;\;-260;\;-360
    Definition / activation
    Staging loiter is active within 0.09 m of \mathbf{p}^{S} when d_{t}^{T}>0.10 m; target-overshoot margin is 0.025 m
  • \mathcal{R}_{t}^{cor}
    Implemented term
    Excessive TCP height; line-band violation; lateral-band violation; vertical-band violation; corridor axial overshoot
    Weight
    -260;\;-330;\;-310;\;-360; -130
    Definition / activation
    The first four terms use \sigma(10(\ell_{t}+0.08)) where applicable; excessive-height threshold is 0.030 m
  • \mathcal{R}_{t}^{ori}
    Implemented term
    Tool-axis alignment reward; approach-axis deficit; vertical-orientation violation; soft vertical-orientation violation
    Weight
    +150;\;-1100;\;-780;\;-320
    Definition / activation
    Alignment reward \exp[-5(1-c_{t}^{a})]; hard/soft vertical thresholds are 0.12/0.085
  • \mathcal{R}_{t}^{safe}
    Implemented term
    Within-tolerance indicator; instantaneous below-plane violation; squared violation; accumulated path violation; initial violation
    Weight
    +80;\;-4200;\;-12000;\;-3600; -2600
    Definition / activation
    Uses instantaneous b_{t}, accumulated \max_{\tau\leq t}b_{\tau}, and the initial safe-start violation
  • \mathcal{R}_{t}^{reg}
    Implemented term
    Constant step cost; action magnitude; action-rate; action acceleration; joint velocity
    Weight
    -0.10;\;-0.0035;\;-0.015; -0.026;\;-0.00050
    Definition / activation
    Penalizes \|\mathbf{u}_{t}\|_{2}^{2}, first/second action differences, and \|\dot{\mathbf{q}}_{t}\|_{2}^{2}; no causal jerk interpretation is implied
  • \mathcal{B}_{t}
    Implemented term
    Valid capture \chi_{t}; strict capture \chi_{t}^{strict}
    Weight
    +250;\;+2400
    Definition / activation
    Strict capture additionally requires initial and accumulated path violation \leq\varepsilon_{safe}

The final-pose capture predicate required the axial, lateral, vertical, and Euclidean position thresholds in Table A.1, c_{t}^{a}>\varepsilon_{a}, c_{t}^{z}<\varepsilon_{v}, and positive instantaneous wrist–TCP chain clearance. Strict capture additionally required both the initial and accumulated below-plane violations to remain within \varepsilon_{safe}. Successful termination required this strict predicate for N_{s} consecutive policy steps; an accumulated violation above \varepsilon_{hard} terminated the episode early.

Table A.4: Exact training modifications used for the PSA-PPO component-removal ablations. Only the listed reward or termination logic was changed relative to the full formulation; observation dimensionality, action processing, target sampling, safe-start construction, capture thresholds, and the post-training strict evaluator were retained.
  • PSA-PPO
    Training modification relative to PSA-PPO
    No component removed. The +2400 strict-capture bonus required final capture, acceptable safe-start clearance, and acceptable accumulated path clearance. Successful termination used the same strict predicate, and accumulated below-plane violation above 0.050 m triggered hard-safety termination.
    Preserved elements
    Complete target, corridor, orientation, path-safety, and motion-regularization formulation.
  • w/o path safety (C2b)
    Training modification relative to PSA-PPO
    Removed the five path-safety reward terms: +80\,\mathbb{I}[b_{t}\leq\varepsilon_{\mathrm{safe}}], -4200\,b_{t}, -12000\,b_{t}^{2}, -3600\,\max(b_{t}^{\max}-\varepsilon_{\mathrm{safe}},0), and -2600\,b_{0}. The +2400 bonus remained, but its gate was changed from strict capture to final capture only. Training success termination likewise used final capture only, and hard-safety termination was disabled.
    Preserved elements
    The 42-D observation, including wrist–TCP clearance channels, was unchanged. Target/corridor/orientation rewards, motion regularization, safe-start logic, and path-safety logging were retained. Strict path safety was restored only in the common post-training evaluator.
  • w/o side corridor (C2c)
    Training modification relative to PSA-PPO
    Removed staging/corridor shaping: +25 staging-progress, -10 staging-distance, +360 line-progress increment, +185 clipped line progress, -260 staging loiter, -260 excessive-TCP-height, -330 line-band, -310 lateral-band, -360 vertical-band, and -130 corridor axial-overshoot terms.
    Preserved elements
    Target-distance and target-frame error terms, orientation, path-safety rewards/history, strict-capture termination, hard-safety termination, and motion regularization were unchanged.
  • w/o motion regularization (C2d)
    Training modification relative to PSA-PPO
    Removed the four action/joint regularizers: -0.0035\|\mathbf{u}_{t}\|_{2}^{2}, -0.015\|\Delta\mathbf{u}_{t}\|_{2}^{2}, -0.026\|\Delta^{2}\mathbf{u}_{t}\|_{2}^{2}, and -0.00050\|\dot{\mathbf{q}}_{t}\|_{2}^{2}. The constant per-step cost -0.10 was retained.
    Preserved elements
    Target, corridor, orientation, path-safety, strict-capture, and termination logic were unchanged.
Table A.5: PPO optimization and actor–critic network configuration.
  • Training seed
    Value
    42
    Setting
    RSL-RL seed
  • Rollout length
    Value
    32 steps/env.
    Setting
    Samples per environment/update
  • Maximum iterations
    Value
    12,000
    Setting
    PPO iterations
  • Actor hidden layers
    Value
    256–256–128
    Setting
    Fully connected
  • Critic hidden layers
    Value
    256–256–128
    Setting
    Fully connected
  • Activation
    Value
    ELU
    Setting
    Hidden activation
  • Initial action-noise std.
    Value
    0.36
    Setting
    Stochastic actor
  • Observation normalization
    Value
    Disabled
    Setting
    Empirical normalization off
  • PPO clip \epsilon
    Value
    0.20
    Setting
    Ratio clipping
  • Clipped value loss
    Value
    Enabled
    Setting
    Value-function clipping
  • Learning rate
    Value
    8\times 10^{-5}
    Setting
    Initial rate
  • Learning-rate schedule
    Value
    Adaptive
    Setting
    KL-based adaptation
  • Discount \gamma
    Value
    0.99
    Setting
    Return discount
  • GAE \lambda
    Value
    0.95
    Setting
    Advantage estimator
  • Entropy coefficient
    Value
    0.0015
    Setting
    Exploration regularization
  • Value-loss coefficient
    Value
    1.0
    Setting
    Critic weighting
  • Learning epochs
    Value
    5
    Setting
    Epochs/update
  • Mini-batches
    Value
    4
    Setting
    Mini-batches/update
  • Desired KL
    Value
    0.010
    Setting
    Adaptive-schedule target
  • Maximum gradient norm
    Value
    1.0
    Setting
    Gradient clipping

Appendix B Simulation Validation and Formulation-Ablation Details

This appendix details the fixed simulation-evaluation setup and diagnostics supporting Section 3.3.1. Identical target coordinates and strict evaluation criteria were used for PSA-PPO and all component-removal baselines (Table B.1).

Table B.1: Fixed random-workspace simulation-evaluation contract.
  • Targets per formulation
    Value
    200
    Setting
    Identical target list
  • Target radius
    Value
    [0.60,1.25] m
    Setting
    Front workspace
  • Target azimuth
    Value
    [-85^{\circ},85^{\circ}]
    Setting
    Front workspace
  • Target height
    Value
    [0.50,0.68] m
    Setting
    Vertical range
  • Radius sampling
    Value
    Area-uniform
    Setting
    Horizontal annulus
  • Target-generation seed
    Value
    20260724
    Setting
    Fixed evaluation set
  • Approach distance
    Value
    0.22 m
    Setting
    Same-height staging distance
  • Strict path tolerance
    Value
    0.002 m
    Setting
    Below-plane criterion
  • Safety-plane margin
    Value
    0 m
    Setting
    Target-height plane
  • Evaluation action multiplier
    Value
    0.75
    Setting
    Deterministic evaluator
  • Near-target action multiplier
    Value
    0.40
    Setting
    Applied within 0.10 m
  • Maximum policy steps
    Value
    280
    Setting
    Per target
  • Additional geometric rules
    Value
    Disabled
    Setting
    Evaluator-side rules off

Binary outcomes were paired by target. Risk differences were computed as PSA-PPO minus the corresponding component-removal rate, with 95% confidence intervals from 10,000 paired bootstrap resamples. Exact McNemar tests were used for paired binary outcomes and Holm correction was applied across the three formulation contrasts within each outcome family. The target, rather than trajectory samples, was the inferential unit. Because one independently trained checkpoint was evaluated per formulation, these intervals and tests characterize variation over the evaluation targets and not retraining variability.

Table B.2: Paired binary outcome differences between PSA-PPO and the three component-removal formulations over the common 200-target set. Positive \Delta favors PSA-PPO.
  • Final reach
    Contrast
    w/o path safety
    PSA-PPO (%)
    99.0
    Variant (%)
    89.0
    \Delta (pp) [95% CI]
    10.0 [6.0, 14.5]
    Holm p
    3.29\times 10^{-5}
  • —
    Contrast
    w/o side corridor
    PSA-PPO (%)
    99.0
    Variant (%)
    100.0
    \Delta (pp) [95% CI]
    -1.0 [-2.5, 0.0]
    Holm p
    1.000
  • —
    Contrast
    w/o motion regularization
    PSA-PPO (%)
    99.0
    Variant (%)
    98.0
    \Delta (pp) [95% CI]
    1.0 [-1.5, 3.5]
    Holm p
    1.000
  • Path-safe
    Contrast
    w/o path safety
    PSA-PPO (%)
    92.5
    Variant (%)
    69.5
    \Delta (pp) [95% CI]
    23.0 [16.5, 29.5]
    Holm p
    1.14\times 10^{-10}
  • —
    Contrast
    w/o side corridor
    PSA-PPO (%)
    92.5
    Variant (%)
    73.0
    \Delta (pp) [95% CI]
    19.5 [14.0, 25.5]
    Holm p
    1.14\times 10^{-10}
  • —
    Contrast
    w/o motion regularization
    PSA-PPO (%)
    92.5
    Variant (%)
    88.5
    \Delta (pp) [95% CI]
    4.0 [1.0, 7.5]
    Holm p
    0.0386
  • Strict
    Contrast
    w/o path safety
    PSA-PPO (%)
    92.0
    Variant (%)
    63.5
    \Delta (pp) [95% CI]
    28.5 [21.5, 35.5]
    Holm p
    1.18\times 10^{-13}
  • —
    Contrast
    w/o side corridor
    PSA-PPO (%)
    92.0
    Variant (%)
    73.0
    \Delta (pp) [95% CI]
    19.0 [13.5, 25.0]
    Holm p
    8.22\times 10^{-10}
  • —
    Contrast
    w/o motion regularization
    PSA-PPO (%)
    92.0
    Variant (%)
    87.0
    \Delta (pp) [95% CI]
    5.0 [1.5, 8.5]
    Holm p
    0.0129

Figure B.1 exposes the paired strict-outcome contingencies underlying the aggregate differences in Table B.2.

Figure B.1: Paired strict outcomes for each component removal over the same 200 targets. Each bar partitions targets into cases where both policies were strictly successful, only PSA-PPO was successful, only the ablated policy was successful, or both failed. \Delta denotes the strict-success rate of PSA-PPO minus that of the corresponding ablation.

The three-dimensional outcome maps in Figure B.2 retain target location and failure type simultaneously. Numerical robustness of the selected PSA-PPO checkpoint across the predefined workspace bins is given in Table B.3; the corresponding multi-policy bin comparison is reported in the main paper.

Figure B.2: Target-wise simulation outcomes over the common workspace for PSA-PPO and the three component-removal formulations. Markers distinguish strict success, safety-only failure, final-only failure, and failure of both criteria. The plots localize evaluation failures but do not represent variation across policy retraining seeds.
Table B.3: Numerical workspace robustness of the selected PSA-PPO checkpoint across predefined equal-width bins.
  • Radius
    Interval
    [0.6000, 0.7625) m
    N
    44
    Final (%)
    97.7
    Path-safe (%)
    95.5
    Strict (%)
    93.2
    Strict 95% CI
    [81.8, 97.7]
    Median error / P95 violation (mm)
    33.16 / 1.34
  • Radius
    Interval
    [0.7625, 0.9250) m
    N
    45
    Final (%)
    100.0
    Path-safe (%)
    97.8
    Strict (%)
    97.8
    Strict 95% CI
    [88.4, 99.6]
    Median error / P95 violation (mm)
    33.63 / 0.00
  • Radius
    Interval
    [0.9250, 1.0875) m
    N
    47
    Final (%)
    100.0
    Path-safe (%)
    95.7
    Strict (%)
    95.7
    Strict 95% CI
    [85.8, 98.8]
    Median error / P95 violation (mm)
    29.89 / 0.36
  • Radius
    Interval
    [1.0875, 1.2500] m
    N
    64
    Final (%)
    98.4
    Path-safe (%)
    84.4
    Strict (%)
    84.4
    Strict 95% CI
    [73.6, 91.3]
    Median error / P95 violation (mm)
    33.15 / 3.63
  • Azimuth
    Interval
    [-85.0, -51.0) deg
    N
    37
    Final (%)
    97.3
    Path-safe (%)
    78.4
    Strict (%)
    78.4
    Strict 95% CI
    [62.8, 88.6]
    Median error / P95 violation (mm)
    32.40 / 6.03
  • Azimuth
    Interval
    [-51.0, -17.0) deg
    N
    42
    Final (%)
    100.0
    Path-safe (%)
    95.2
    Strict (%)
    95.2
    Strict 95% CI
    [84.2, 98.7]
    Median error / P95 violation (mm)
    33.11 / 0.62
  • Azimuth
    Interval
    [-17.0, 17.0) deg
    N
    39
    Final (%)
    100.0
    Path-safe (%)
    94.9
    Strict (%)
    94.9
    Strict 95% CI
    [83.1, 98.6]
    Median error / P95 violation (mm)
    31.24 / 1.53
  • Azimuth
    Interval
    [17.0, 51.0) deg
    N
    43
    Final (%)
    97.7
    Path-safe (%)
    97.7
    Strict (%)
    95.3
    Strict 95% CI
    [84.5, 98.7]
    Median error / P95 violation (mm)
    31.50 / 0.84
  • Azimuth
    Interval
    [51.0, 85.0] deg
    N
    39
    Final (%)
    100.0
    Path-safe (%)
    94.9
    Strict (%)
    94.9
    Strict 95% CI
    [83.1, 98.6]
    Median error / P95 violation (mm)
    34.06 / 0.20
  • Height
    Interval
    [0.500, 0.560) m
    N
    64
    Final (%)
    100.0
    Path-safe (%)
    98.4
    Strict (%)
    98.4
    Strict 95% CI
    [91.7, 99.7]
    Median error / P95 violation (mm)
    33.48 / 0.13
  • Height
    Interval
    [0.560, 0.620) m
    N
    60
    Final (%)
    98.3
    Path-safe (%)
    91.7
    Strict (%)
    91.7
    Strict 95% CI
    [81.9, 96.4]
    Median error / P95 violation (mm)
    30.60 / 2.59
  • Height
    Interval
    [0.620, 0.680] m
    N
    76
    Final (%)
    98.7
    Path-safe (%)
    88.2
    Strict (%)
    86.8
    Strict 95% CI
    [77.4, 92.7]
    Median error / P95 violation (mm)
    33.09 / 3.40

Representative target-matched trajectories selected for each component contrast are shown in Figure B.3. They are included as qualitative diagnostics and are not used to estimate population effects.

Figure B.3: Representative trajectory overlays for the three component-removal contrasts. The displayed targets were selected from the common evaluation set to expose the corresponding contrast: target 65 for path-safety removal, target 31 for side-corridor removal, and target 199 for motion-regularization removal. The star marks the target location. These examples supplement, rather than replace, the paired population statistics.

The fixed-band corridor measures in Figure B.4 were reconstructed post hoc from the recorded trajectories. They are not mathematically identical to \mathcal{R}^{cor}_{t}, which also contains continuous progress, overshoot, staging, and target-coupled terms. They are therefore reported as secondary diagnostics rather than as an isolated decomposition of the corridor reward.

Figure B.4: Post-hoc fixed-band corridor diagnostics over the common target set: fraction of trajectory samples inside both lateral and vertical bands, per-target P95 absolute lateral error, and per-target P95 absolute vertical error. The distributions do not exhibit a uniform ordering across formulations and should not be interpreted as a direct measurement of the complete corridor reward.

Figure B.5 reports quantities aligned directly with the removed motion-regularization terms. The no-motion-regularization checkpoint does not produce a monotonic increase in these quantities, which is why the main paper does not attribute lower TCP jerk causally to \mathcal{R}^{reg}_{t}.

Figure B.5: Empirical distributions of direct motion-regularization diagnostics: raw-action-rate RMS, raw-action-acceleration RMS, and joint-velocity-norm RMS. The no-motion-regularization policy does not shift these quantities uniformly toward larger values, demonstrating that the component removal changes the learned operating point rather than providing a monotonic smoothness test.

Tool-orientation behavior is provided in Figure B.6. Orientation shaping and the final orientation criteria were retained in all three ablations.

Figure B.6: Final tool-orientation distributions over the common evaluation set: approach-axis alignment (left) and absolute tool-axis vertical component (right). Orientation terms and final orientation criteria were unchanged across the three component-removal formulations.

Appendix C Physical Controller Benchmark and Deployment Details

This appendix documents the controller configurations, measured-trajectory processing, analysis populations, and secondary diagnostics supporting the physical comparison in Section 3.3.2. Binary reaching outcomes use all scheduled targets for each controller, whereas continuous motion comparisons use the common-success target population defined below.

C.1 Physical Execution and Planner Configuration

The controlled benchmark used the same physical target definitions for PSA-PPO, Cartesian+TOTG, RRTConnect, and RRT*. The paper-level reaching criterion was a 20-mm Cartesian tolerance. The online controller monitor used a tighter 2-mm threshold for execution management; this monitor threshold was not used to define the reported task success.

Table C.1: Principal physical execution and logging parameters used for PSA-PPO deployment and the controlled real-robot benchmark.
  • HOME TCP position
    Value
    [-0.164,\;0.641,\;0.382] m
    Role
    Robot observation/home pose
  • Benchmark tool orientation (w,x,y,z)
    Value
    [0.009162454,\;0.005118748,\;0.718754832,\;0.695184393]
    Role
    Common fixed physical orientation
  • Base frame
    Value
    robot_arm_base_link
    Role
    Cartesian reference frame
  • Tool frame
    Value
    robot_arm_tool0
    Role
    Measured TCP frame
  • Paper evaluation tolerance
    Value
    0.020 m
    Role
    Binary target-reaching criterion
  • ROS monitor tolerance
    Value
    0.002 m
    Role
    Online execution-monitor threshold
  • Consecutive monitor checks
    Value
    5
    Role
    Required in-tolerance monitor observations
  • TCP/TF sampling rate
    Value
    100 Hz
    Role
    Measured trajectory sampling
  • Endpoint window
    Value
    0.50 s
    Role
    Terminal TCP estimation window
  • Motion timeout
    Value
    12.0 s
    Role
    Maximum PSA-PPO reach command interval
  • Acceleration pre-check threshold
    Value
    3.0 rad/s2
    Role
    Pre-command hardware safeguard
  • Acceleration trip threshold
    Value
    3.0 rad/s2
    Role
    Feedback-based HOLD/HALT threshold
  • Time-shaping acceleration
    Value
    0.0045 rad/s2
    Role
    PSA-PPO trajectory-duration shaping limit

PSA-PPO retained the frozen deployment correction described in Section 2.4. Table C.1 summarizes the execution and logging parameters used for PSA-PPO deployment on the UR10e. Planner targets were supplied directly to MoveIt without that policy-specific Cartesian correction. Accordingly, the benchmark compares the complete deployed controllers under common target definitions rather than claiming identical low-level command generation.

The MoveIt baselines used a common staged physical benchmark harness. For each stage, the measured current joint state was supplied as the planner start state when available, and a planned-start mismatch above 0.005 rad prevented execution. OMPL-generated trajectories were collision checked by MoveIt and then sent directly to the UR scaled joint-trajectory controller. Cartesian motion used collision-checked Cartesian interpolation followed by time-optimal trajectory generation (TOTG). The principal planner settings are listed in Table C.2.

Table C.2: MoveIt baseline configuration used in the controlled physical benchmark. Parameters listed as common were applied to the planner-based controllers unless the backend required a method-specific setting.
  • Move group
    Value
    arm
    Application
    All MoveIt baselines
  • RRTConnect backend
    Value
    OMPL RRTConnect (RRTConnectkConfigDefault)
    Application
    Pose planning using the frozen RRTConnect planner ID
  • RRT* backend
    Value
    OMPL RRT* (RRTstar)
    Application
    Pose planning using the post-fix RRT* planner ID
  • Cartesian backend
    Value
    Cartesian linear + TOTG (CartesianLinearTOTG)
    Application
    Collision-checked Cartesian interpolation followed by retiming
  • Planning time
    Value
    8.0 s
    Application
    OMPL pose planners
  • Planning attempts
    Value
    3
    Application
    OMPL pose planners
  • Velocity scaling
    Value
    0.10
    Application
    MoveIt trajectory generation/retiming
  • Acceleration scaling
    Value
    0.10
    Application
    MoveIt trajectory generation/retiming
  • Goal-position tolerance
    Value
    0.002 m
    Application
    MoveIt pose target
  • Goal-orientation tolerance
    Value
    0.035 rad
    Application
    MoveIt pose target
  • Maximum start-state mismatch
    Value
    0.005 rad
    Application
    Measured-versus-planned joint start check
  • Cartesian EEF step
    Value
    0.005 m
    Application
    Cartesian interpolation
  • Minimum Cartesian fraction
    Value
    0.999
    Application
    Required fraction for Cartesian plan acceptance
  • Cartesian collision checking
    Value
    Enabled
    Application
    avoid_collisions=True
  • Cartesian retiming
    Value
    TOTG
    Application
    time_optimal_trajectory_generation
  • Replanning
    Value
    Disabled
    Application
    All MoveIt baselines
  • Planner safe-height offset
    Value
    0.035 m
    Application
    z_{\mathrm{safe}}=z^{T}+0.035 m for the staged planner approach
  • Planner far/near backoff
    Value
    -0.040/-0.020 m
    Application
    Intermediate staged approach offsets along the benchmark y direction
  • Execution interface
    Value
    FollowJointTrajectory
    Application
    /robot/arm/scaled_pos_traj_controller/ follow_joint_trajectory

The final RRT* batch wrapper explicitly passed planner_id = RRTstar and verified that the corresponding ROS planner configuration resolved to an RRT* implementation before execution. The earlier RRTstarkConfigDefault wrapper was superseded and is not used as the provenance for the reported RRT* configuration.

C.2 Trajectory Reconstruction and Analysis Populations

TCP transforms and joint/controller states were archived at 100 Hz for all controllers. All cross-controller kinematic and trajectory-geometry quantities reported in the paper were recomputed offline from these raw trajectory archives using one common processing pipeline; the online per-segment path/speed/acceleration/jerk estimates produced during data collection were not used for the comparative analysis because invalid online path-length estimates were observed for some RRTConnect segments. In the common offline pipeline, samples were timestamp ordered, resampled to a uniform grid, and smoothed using a 0.15-s moving-average window before derivative-based analysis. Trajectory length was evaluated from the smoothed position stream at 30 Hz, with a 2-mm Ramer–Douglas–Peucker tolerance used for geometric simplification. TCP velocity, acceleration, and jerk were obtained by central finite differences. The reported high-end jerk statistic is the 99.5th percentile rather than the numerical maximum. The final 0.22-m target-relative window was fixed from the local PSA-PPO task definition before controller comparison and was applied identically to all methods.

Binary reliability and continuous trajectory comparisons use different populations by construction. All scheduled targets contribute to binary reaching outcomes. Continuous controller comparisons condition on targets retained as successful for all four controllers, so that each paired metric compares the same physical target configuration. Table C.3 summarizes these populations.

Table C.3: Physical benchmark populations used for binary and continuous controller comparisons.
  • Scheduled targets
    PSA-PPO
    150
    Cartesian+TOTG
    150
    RRTConnect
    150
    RRT*
    150
  • Archived measured trajectories
    PSA-PPO
    150
    Cartesian+TOTG
    150
    RRTConnect
    150
    RRT*
    125
  • Paper-level reached targets
    PSA-PPO
    142
    Cartesian+TOTG
    129
    RRTConnect
    132
    RRT*
    120
  • Paper-level failed targets
    PSA-PPO
    8
    Cartesian+TOTG
    21
    RRTConnect
    18
    RRT*
    30

The physical target was treated as the experimental unit. Paired continuous differences were evaluated using Wilcoxon signed-rank tests and 10,000 paired bootstrap resamples for confidence intervals. Holm correction was applied within each prespecified family of PSA-PPO–planner comparisons. Trajectory samples within a target were not treated as independent observations.

C.3 Detailed Motion and Geometry Statistics

The main paper emphasizes the final 0.22-m local region because this matches the learned crop-proximal control scope. Table C.4 shows that the same qualitative dynamic ordering is also present over the complete reconstructed approach.

Table C.4: Selected physical motion metrics over the complete reconstructed approach on the common-success target set (N=97). Values are controller medians. Lower values indicate lower dynamic excitation or tracking error.
  • RMS acceleration (m/s2)
    PSA-PPO
    0.1776
    Cartesian+TOTG
    0.5776
    RRTConnect
    0.5856
    RRT*
    0.2739
  • RMS jerk (m/s3)
    PSA-PPO
    15.82
    Cartesian+TOTG
    47.68
    RRTConnect
    45.01
    RRT*
    19.91
  • 99.5th-percentile jerk (m/s3)
    PSA-PPO
    105.11
    Cartesian+TOTG
    143.38
    RRTConnect
    172.29
    RRT*
    127.58
  • Joint-position tracking RMSE (rad)
    PSA-PPO
    8.41\times 10^{-4}
    Cartesian+TOTG
    2.87\times 10^{-3}
    RRTConnect
    2.76\times 10^{-3}
    RRT*
    1.31\times 10^{-3}

Target-wise effect sizes for the final 0.22-m region are reported in Table C.5. Differences are defined as PSA-PPO minus planner, so negative values indicate a lower PSA-PPO metric. The endpoint-error ECDF is provided in the main paper; the numerical medians are retained in Table C.6 for direct lookup. Population-level trajectory geometry is reported in Table C.7 because lower dynamic excitation does not imply a shorter or straighter path.

Table C.5: Paired effect-size analysis for PSA-PPO relative to each classical planner within the final 0.22-m target-relative approach. Differences are computed target-wise over the identical common-success set (N=97).
  • RMS acceleration (m/s2)
    Planner
    Cartesian+TOTG
    PSA-PPO reduction (%)
    75.9
    Median paired difference [95% CI]
    -0.4012 [-0.4118,-0.3953]
    Holm-adjusted p
    4.02\times 10^{-16}
  • —
    Planner
    RRTConnect
    PSA-PPO reduction (%)
    77.1
    Median paired difference [95% CI]
    -0.4295 [-0.4419,-0.4162]
    Holm-adjusted p
    4.02\times 10^{-16}
  • —
    Planner
    RRT*
    PSA-PPO reduction (%)
    52.4
    Median paired difference [95% CI]
    -0.1332 [-0.1398,-0.1303]
    Holm-adjusted p
    4.02\times 10^{-16}
  • RMS jerk (m/s3)
    Planner
    Cartesian+TOTG
    PSA-PPO reduction (%)
    73.0
    Median paired difference [95% CI]
    -30.71 [-31.79,-29.83]
    Holm-adjusted p
    4.02\times 10^{-16}
  • —
    Planner
    RRTConnect
    PSA-PPO reduction (%)
    72.1
    Median paired difference [95% CI]
    -29.34 [-30.62,-28.54]
    Holm-adjusted p
    4.02\times 10^{-16}
  • —
    Planner
    RRT*
    PSA-PPO reduction (%)
    39.8
    Median paired difference [95% CI]
    -7.177 [-7.625,-6.442]
    Holm-adjusted p
    4.02\times 10^{-16}
  • Jerk P_{99.5} (m/s3)
    Planner
    Cartesian+TOTG
    PSA-PPO reduction (%)
    41.1
    Median paired difference [95% CI]
    -57.80 [-63.84,-53.18]
    Holm-adjusted p
    4.02\times 10^{-16}
  • —
    Planner
    RRTConnect
    PSA-PPO reduction (%)
    52.8
    Median paired difference [95% CI]
    -91.01 [-98.11,-80.84]
    Holm-adjusted p
    4.02\times 10^{-16}
  • —
    Planner
    RRT*
    PSA-PPO reduction (%)
    39.2
    Median paired difference [95% CI]
    -49.96 [-55.02,-44.42]
    Holm-adjusted p
    4.02\times 10^{-16}
  • Joint tracking RMSE (rad)
    Planner
    Cartesian+TOTG
    PSA-PPO reduction (%)
    72.8
    Median paired difference [95% CI]
    -1.840\times 10^{-3} [-1.868,-1.804]\times 10^{-3}
    Holm-adjusted p
    4.02\times 10^{-16}
  • —
    Planner
    RRTConnect
    PSA-PPO reduction (%)
    71.8
    Median paired difference [95% CI]
    -1.785\times 10^{-3} [-1.816,-1.742]\times 10^{-3}
    Holm-adjusted p
    4.02\times 10^{-16}
  • —
    Planner
    RRT*
    PSA-PPO reduction (%)
    39.4
    Median paired difference [95% CI]
    -4.629\times 10^{-4} [-4.912,-4.179]\times 10^{-4}
    Holm-adjusted p
    4.02\times 10^{-16}
Table C.6: Terminal positioning accuracy on the common-success physical target set. The physical reaching tolerance was 20 mm.
  • PSA-PPO
    Median TCP error (mm)
    9.78
    Fraction of 20-mm tolerance (%)
    48.9
  • Cartesian+TOTG
    Median TCP error (mm)
    0.06
    Fraction of 20-mm tolerance (%)
    0.3
  • RRTConnect
    Median TCP error (mm)
    1.62
    Fraction of 20-mm tolerance (%)
    8.1
  • RRT*
    Median TCP error (mm)
    1.61
    Fraction of 20-mm tolerance (%)
    8.1
Table C.7: Trajectory-geometry and spatial-excursion statistics over the full reconstructed physical approach. Median quantities characterize typical path geometry; P_{95} and maximum deviations characterize distribution tails.
  • Detour ratio
    PSA-PPO
    1.8094
    Cartesian+TOTG
    1.6697
    RRTConnect
    1.6812
    RRT*
    1.6962
  • Path efficiency
    PSA-PPO
    0.5527
    Cartesian+TOTG
    0.5989
    RRTConnect
    0.5948
    RRT*
    0.5896
  • Backtracking ratio
    PSA-PPO
    0.0371
    Cartesian+TOTG
    0.0178
    RRTConnect
    0.0195
    RRT*
    0.0218
  • Total Cartesian turning (∘)
    PSA-PPO
    410.09
    Cartesian+TOTG
    16.91
    RRTConnect
    75.58
    RRT*
    75.14
  • Base-azimuth travel (∘)
    PSA-PPO
    26.25
    Cartesian+TOTG
    25.73
    RRTConnect
    25.97
    RRT*
    26.45
  • Total joint travel (rad)
    PSA-PPO
    3.108
    Cartesian+TOTG
    2.850
    RRTConnect
    2.910
    RRT*
    2.723
  • P_{95} maximum line deviation (mm)
    PSA-PPO
    235
    Cartesian+TOTG
    235
    RRTConnect
    237
    RRT*
    235
  • Maximum line deviation (mm)
    PSA-PPO
    292
    Cartesian+TOTG
    297
    RRTConnect
    297
    RRT*
    297
  • P_{95} base-azimuth travel (∘)
    PSA-PPO
    61.1
    Cartesian+TOTG
    61.2
    RRTConnect
    61.5
    RRT*
    61.6
  • Maximum base-azimuth travel (∘)
    PSA-PPO
    66.9
    Cartesian+TOTG
    66.8
    RRTConnect
    67.1
    RRT*
    67.0
  • Full-base-revolution events
    PSA-PPO
    0/97
    Cartesian+TOTG
    0/97
    RRTConnect
    0/97
    RRT*
    0/97
  • Any full-joint-revolution events
    PSA-PPO
    0/97
    Cartesian+TOTG
    0/97
    RRTConnect
    0/97
    RRT*
    0/97

C.4 Failure-Identity Sensitivity and Timing Semantics

The aggregate physical reaching totals were witnessed during the experiment, but the exact target identities of some additional planner failures were not independently preserved. These counts were therefore not retrospectively treated as recovered target-level ground truth. Instead, a deterministic sensitivity analysis retained the witnessed aggregate totals and selected the additional planner failure identities from originally logged-success trials using telemetry anomaly rank.

Hard diagnostic events were prioritized when tool-orientation travel reached at least 360^{\circ}, any single-joint travel reached at least 2\pi, or the wrist/elbow angular margin to the nearest multiple of \pi was at most 5^{\circ}. Remaining trials were ranked within each planner using percentile tails of trajectory geometry, orientation travel, joint excursion, acceleration, jerk, tracking error, and elapsed duration. The composite score was

S_{k}=0.60\,\bar{P}_{k}+0.25\,P_{k}^{\max}+0.15\,I_{k}^{\mathrm{hard}},
(C.1)

where \bar{P}_{k} and P_{k}^{\max} denote the mean and maximum within-planner diagnostic percentiles, respectively. Target ID was used to break ties. The selected identities were used only to form a sensitivity population consistent with the witnessed counts; they are not claimed as independently observed failure identities. Table C.8 summarizes the witnessed failure counts, trajectory availability, and anomaly-ranked identity selections used to construct this sensitivity population.

Table C.8: Summary of the anomaly-ranked witnessed-count sensitivity construction for the planner baselines.
  • Cartesian+TOTG
    Witnessed failures
    21
    Additional ranked identities selected
    19
    Archived trajectories
    150
    Hard-event selected trials
    0
    Highest-priorityt diagnostic target
    T119
  • RRTConnect
    Witnessed failures
    18
    Additional ranked identities selected
    18
    Archived trajectories
    150
    Hard-event selected trials
    3
    Highest-priorityt diagnostic target
    T040
  • RRT*
    Witnessed failures
    30
    Additional ranked identities selected
    5
    Archived trajectories
    125
    Hard-event selected trials
    4
    Highest-priorityt diagnostic target
    T087

Timing variables from the benchmark are retained only as harness diagnostics. The PSA-PPO harness issued multiple external commands and monitored the TCP against the 2-mm execution threshold, whereas the paper-level outcome uses 20 mm. Consequently, elapsed benchmark time includes monitoring and waiting behavior and cannot be interpreted as neural-network inference latency or as intrinsic controller execution speed. The audit found that only 32 of 1080 PSA-PPO harness commands reached the 2-mm monitor threshold; 1048 did not reach that threshold before monitor completion or timeout, and all 142 paper-level successful PSA-PPO targets contained at least one such inferred 2-mm timeout. For this reason, timing is classified as benchmark-harness-dependent and is excluded from controller-speed claims.

C.5 Kinematic and Atypical-Trajectory Diagnostics

Singularity proximity was evaluated as a diagnostic rather than a causal failure label. Wrist and elbow margins were defined as the minimum absolute angular distance to a multiple of \pi for UR joint 5 and joint 3, respectively. The 5^{\circ} threshold in Figure C.1 was used only by the anomaly-ranking audit; proximity to this threshold does not demonstrate that a singularity caused a stall or failed reach.

Figure C.1: Minimum wrist- and elbow-angle margins to the nearest multiple of \pi in the physical benchmark. The dashed 5^{\circ} reference denotes the diagnostic threshold used by the anomaly-ranking sensitivity analysis. The quantity is kinematic evidence only; near-threshold configurations are not interpreted as proof of singularity-induced failure.

Within the sensitivity-selected sets, Cartesian+TOTG contained no orientation-revolution, single-joint-revolution, or near-singularity hard events. The RRTConnect selected set contained two orientation-revolution events, one single-joint-revolution event, three wrist-near-singularity cases, and one elbow-near-singularity case. The RRT* selected set contained four, three, two, and one such cases, respectively. These counts describe the selected diagnostic subsets and not the N=97 population as a whole.

Figure C.2 shows the highest-priority selected planner execution together with PSA-PPO on the same target. The Cartesian case is the highest-ranked non-hard anomaly because no Cartesian hard event was present in the selected set. The RRTConnect and RRT* examples contain hard diagnostic events under the predefined audit rule. These examples illustrate tail behavior only and are not classified as collision events.

Figure C.2: Matched target-level trajectory diagnostics from the anomaly-ranked sensitivity analysis: (a) PSA-PPO and Cartesian+TOTG on T119, (b) PSA-PPO and RRTConnect on T040, and (c) PSA-PPO and RRT* on T087. The examples are the highest-priority selected planner cases for their respective methods and are not representative population trajectories. Spatially expansive motion and near-singularity diagnostics are not interpreted as collision events or as proof of failure causation.