pid汇编算法，可以根据实际情况修改，希望对需要的朋友门有所帮助-pid compilation algorithm, according to the actual situation can be amended in the hope that the door of a friend in need help