小车巡线控制算法PV=ReadMotorSpeed()Error=SP-PVCV=Error*KpropSetpwm(cv)Gotoloop