Initial commit of functions from github.com/btracey/optimize

As above.