Track papers across labs, topics, and trends.
Search papers, labs, and topics across Lattice.
This paper introduces TSC-VP-STO, an extension of the Via-Point-based Stochastic Trajectory Optimization (VP-STO) algorithm that incorporates task-space constraints to enhance motion planning for forestry cranes. By allowing for adaptive end configurations based on environmental conditions and hydraulic flow demands, the method significantly improves trajectory durations and pump-flow utilization. Experimental results indicate an average reduction in trajectory durations of 12-15% compared to the baseline VP-STO, demonstrating its effectiveness in real-world applications.
Task-space constraints can reduce forestry crane trajectory durations by 12-15%, optimizing both motion planning and hydraulic efficiency.
Efficient, collision-free, and time-optimal motion planning is a fundamental requirement for autonomous forestry cranes operating under hydraulic pump-flow constraints. The Via-Point-based Stochastic Trajectory Optimization (VP-STO) algorithm has demonstrated near-time-optimal hybrid motion planning in this domain, but requires a fixed terminal joint configuration specified prior to optimization. For kinematically redundant manipulators such as forestry cranes, this pre-commitment to a single inverse kinematics solution restricts the planner's ability to exploit redundancy, particularly under the nonlinear, globally coupled pump-flow constraint where admissible joint velocities depend on their combined hydraulic demand. This paper presents TSC-VP-STO, a task-space-constrained extension of VP-STO that replaces the strict terminal joint-space constraint with a task-space constraint, jointly optimizing the trajectory and the redundant degrees of freedom of the terminal configuration. This enables the planner to adapt end configurations to the environment-dependent motion and hydraulic flow allocation, yielding more balanced pump utilization and shorter trajectory durations. We formalize the approach through a configuration space decomposition and derive a concrete reachability constraint for the forestry crane kinematics. Experimental evaluations across multiple planning targets and via-point configurations demonstrates a reduction on trajectory durations by 12-15% on average and improved pump-flow utilization compared to the baseline VP-STO. The practical applicability of TSC-VP-STO is validated through real-world deployment on a forestry crane, including a full log-loading cycle.