Some fixes and simplifications
Reduce blackbox_send() intervals
Add a identifier to pid
Turn pid_update more legible

Also already sending derivative term to blackbox module, maybe in future
I will add second PID, to run with gyro values.
Add some flags to check code and fix the warnings
Just a test