"You can get some inspiration from there.
https://ghowen.me/build-your-own-quadcopter-autopilot/
Please share any work. I plan on doing something like that in near future and would be very interested to follow your advancement."