Tp: 指定速度
Kp: 比例常數
error: 偏差值
middle: 反射光中間值
左-反射: 顏色紅外感測器 反射光強度。(黑0~80白)
右-灰階: 顏色感測器的灰階數值。(黑80~0白)
Tp=50
Kp=0.6
error = (左-反射+右-灰階) - 80
左輪: Tp + error*Kp
右輪: Tp - error*Kp