Chenged the add features function, so that using the current features, the model will become a PD controller