review comments
moved clamp to safe
added ClampSetSuffix and converted flight control
added first pid controller