Finished the SVP Ndof algorithms, and started to lay down the math for SAP Ndof algo.