代码以及仿真经过测试，没有问题，代码采用库的形式编写，便于阅读和使用，结构清晰，移植简单。希望对大家有所帮助。