Adds different realizations of PID.

Adds pid with cutting the max speed.
Adds pid with cutting the max speed except the last 100ms.
Adds pid with counting error as the difference between expected
angle and current.
Merging