This PR avoids re-initializing the OSQP workspace when disabling warm starts, and instead directly handles the warm start setting at each solve. It also turns off warm-starting for the first solve of each new contact mode to avoid starting from an inaccurate guess.
This PR avoids re-initializing the OSQP workspace when disabling warm starts, and instead directly handles the warm start setting at each solve. It also turns off warm-starting for the first solve of each new contact mode to avoid starting from an inaccurate guess.
This change is