Hello
I have more project that design PCB board and firmware for ATMega MCU based on Arduino/AVR IDE/MikroC IDE with IMU and accelerator.
If you have a review on my profile, you will see a project with arm robots is similar as your project.
So, please give me a time to have a details disscuss on this project.
Hope we can work together.
Have a good day.