Added more tests, and modified existent tests to test I behaviour.
Implemented "I" behaviour. Completing the PID controller.