PD controller for simulation which only support effort command input