Joint Space Trajectory Planning Considering Physical Limits for Two-wheeled Mobile Robots

摘要

This paper presents a trajectory planning algorithm for TMR (Two-wheeled Mobile Robots). The trajectory is developed in joint space and considers the physical limits of a TMR. First, we present a process for generating a smooth curve through a Bezier curve. The trajectory for the center of the TMR following the Bezier curve is developed through a convolution operator taking into consideration its physical limits. The trajectory along the Bezier curve is regenerated using time-dependent parameters which correspond to the distance driven by the velocity of the center of the TMR in a sampling time. The velocity commands in the Cartesian space are converted to actuator commands for two wheels. In case that the actuator commands exceed the maximum velocity, the trajectory is redeveloped with compensated center velocity. We also suggest a smooth trajectory planning algorithm in joint space for the two segmented paths. Finally, the effectiveness of the algorithm is shown through numerical examples and application to a simulator.