Collision Detection for Vacuum Wafer Transfer Robot
摘要
In response to safety concerns caused by wafer transmission robot collisions in confined vacuum chambers, which can lead to wafer breakage and production line contamination, a collision detection and response method is proposed, leveraging the robot’s dynamics model and adjustable acceleration thresholds. The structure and motion characteristics of the robot were first analyzed. Subsequently, its kinematic and dynamic models were established and validated via simulation. To reduce noise interference, the dynamics model was computed using a reference trajectory from the host planner. Cross-correlation analysis was used to identify phase differences between the planned and encoder feedback trajectories, enabling phase compensation. For collision threshold settings, an acceleration-based adjustment scheme was developed, taking into account potential collision risk levels. Experimental tests on the vacuum robot verified the effectiveness of the proposed method.