GitLab

first try of multithreading using atomic library. Kind of works but still have problems with protection. Next: mutex

added quadratic constraints. Now we notice how the delay affects the system, we dont have time to solve the problem

added a lot of matrix functions that linearize/discretize/form the matrices linearized along a trayectory. Need to do next the SxSuSg function