Integrated gflags. Implemented SVD pseudoinverses and two softening methods. Pulled velocity control parameters out into flags. Cleaned up planning code.