Introduced a way of passing the parameters for PID tuning.

Seems that Kp = 2 allows the drone to statilizes itself if aided.