deleted Kd term and Hubo_Control "t"