Fix rhc control algorithm