小車巡線控制算法 PV=ReadMotorSpeed() Error=SP-PV CV=Error*Kprop Setpwm(cv) Goto loop