Underactuated Waypoint Trajectory Optimization for Light Painting Photography

Despite their abundance in robotics and nature, underactuated systems remain a challenge for control engineering. Trajectory optimization provides a generally applicable solution, however its efficiency strongly depends on the skill of the engineer to frame the problem in an optimizer-friendly way. This paper proposes a procedure that automates such problem reformulation for a class of tasks in which the desired trajectory is specified by a sequence of waypoints. The approach is based on introducing auxiliary optimization variables that represent waypoint activations. To validate the proposed method, a letter drawing task is set up where shapes traced by the tip of a rotary inverted pendulum are visualized using long exposure photography.

[1]  Frank L. Lewis,et al.  Optimal Control , 1986 .

[2]  C. Hargraves,et al.  DIRECT TRAJECTORY OPTIMIZATION USING NONLINEAR PROGRAMMING AND COLLOCATION , 1987 .

[3]  K Furuta,et al.  Swing-up Control of Inverted Pendulum Using Pseudo-State Feedback , 1992 .

[4]  Mark W. Spong,et al.  Partial feedback linearization of underactuated mechanical systems , 1994, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS'94).

[5]  J. Betts.  Survey of Numerical Methods for Trajectory Optimization , 1998 .

[6]  Mark W. Spong,et al.  Underactuated mechanical systems , 1998 .

[7]  Rogelio Lozano,et al.  Non-linear Control for Underactuated Mechanical Systems , 2001 .

[8]  Howie Choset,et al.  Principles of Robot Motion: Theory, Algorithms, and Implementation ERRATA!!!! 1 , 2007 .

[9]  Z. Prime,et al.  On the dynamics of the furuta pendulum , 2011 .

[10]  Todd D. Murphey,et al.  Trajectory generation for underactuated control of a suspended mass , 2012, 2012 IEEE International Conference on Robotics and Automation.

[11]  Stefan Schaal,et al.  Automatic LQR tuning based on Gaussian process global optimization , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[12]  Alois Knoll,et al.  An Efficient and Time-Optimal Trajectory Generation Approach for Waypoints Under Kinematic Constraints and Error Bounds , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[13]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.