Dev

Add anderson thermostat algorithm. Fix many bugs.