Chapter 13 A SEMI-INFINITE OPTIMIZATION APPROACH TO OPTIMAL SPLINE TRAJECTORY PLANNING OF MECHANICAL MANIPULATORS