用来做转子动平衡的C语言核心程序,很容易改造成其他语言的代码