P controller added for testing