Adding test programs
Changed CMakeLists.txt for new test programs
Modified robust least squares