multirotor_pos_control fixes

Fixed issue with integral component in position control PID. Includes PID library fixes: makes PID library more safe, parameters can be set only from pid_set_parameters(), but not from pid_init(). Some cleanup.