c源代码,希望对大家有帮助,已经验证过,移植到stm32平台