Symplectic Pseudospectral Methods for Optimal Control: Theory and Applications in Path Planning (Intelligent Systems, Control and Automation: Science and Engineering)