卡尔曼滤波器，两轮平衡车使用，入参是陀螺仪和加速计采集的数据（ADC采集之后统一成弧度单位制）R_angle可以调节output的平滑度-kalman filter for balance robot(input are rad value,+ or-, source from gyroscope and accelerometer)， parameter R_angle could configure bigger to make output smoother