Define pid control structure
create a structure member for ahrs_t to store the fusion attitude
Merge https://github.com/Khan-drone/ahrs-core
Add some new members to pid data type
Implement the attitude pd controller