为了给电赛控制B题做准备时做的一个代码，采用了MPU6050和STM32，配合空心杯电机制作，角度获取采用了互补滤波算法，电机控制用的PD控制。