Simple-Robotics / proxsuite C++ 606 80 The Advanced Proximal Optimization Toolbox cpp eigen3 linear-programming optimization