C车 电磁组测得的角度和角速度怎么融合求的速度

┼梦中身┮

C车 电磁组测得的角度和角速度怎么融合求的速度  求高手给以例程  最好每行加上注解的   感激不尽   （没有贡献了）
  谢谢{:soso_e190:}