Introduction - If you have any usage issues, please Google them yourself
The following is a PID control code, I placed directly inside the main function
Only a PD control, did not add the integral term.
MPU6050 sampling rate set at 200Hz, the PWM frequency is 200Hz power transfer