Singularity Avoidance with Application to Online Trajectory Optimization for Serial Manipulators