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

NexDirection -> NextDirection