Implemented a simple P-controller. See Email for details.