First UCDS tests
Making different diags more flexible
Header
Now udcs.c as plug in file
Now header finished
Have two versions of conjugate gradient.
Code ready to be moved over in morning.
UCDS and Conjugate Gradient are bug free
Merge https://github.com/peterkmurphy/thesis-control