This is to make MuFastSteering reentrant motivated by ATR-21908 . Based on advice from @smh , the simple code changes are made at first : many functions(e.g. calc_residual_phi) that can be marked const without any other changes. @atlasbot