プログラマ専用SNS ミクプラ

みなさんはじめまして。宜しくお願いいたします。
ずっと我流でライントレースをやってきて、ここにきてＰＤ制御を入れ込もうと思ったのですが、なかなか上手くいかず、ずっと悩んでいます。
是非、アドバイスをお願いいたします。

ロボットの仕様は　デジタルセンサ１５個　２輪にＤＣモータが１つずつ付いている、対向２輪式です。車両中心にロータリエンコーダもついています。
ベースのプログラムは、ＭＣＲのサンプルプログラムを、ハンドル操作を無くした状態で使用しています。
デジタルセンサは、直線ではなく、ハの字型に並んでいます。

今までは、モータ出力は、センサ値を読み込んで、出力していました。

出力の根拠は、例えば車両がライン上にあるとき、中心から右に３個目のデジタルセンサに反応がある→R21のカーブ（エフテックという会社のサイトを参考にしました）→右のモータ出力を40に(100,40)（これもトレッドから計算で出しています）　
というような感じです。ですが、この状態ですと、大会に出ているようなずっと中心を維持しながら走るような走行にはなりません。

そこでＰＩＤ制御を知ったのですが（どこかのサイトにライントレースならPDでもＯＫとあったので、ＰＤをとりあえず実装しようと思いました）、

まず、

P制御→　KP ×　(　前回の偏差－今回の偏差　）　
ここで、「偏差」が、目標値からの差とあったので、センサ値の目標は100だから・・・・？　仮にセンサ値が40なら、偏差は60?や、そのままセンサ値を使用してみたり、

D制御→ KD × ( ( 今回の偏差－前回の偏差) －(前回の偏差－前々回の偏差))

など、正直エクセルで色々計算してみても、何が正しい考え方なのか、よくわかっていない状況です。

デジタルセンサでＰＤ制御をというのも無謀かもしれませんが、是非、ご教示お願いいたします。

zc31rar@docomo.ne.jp 　もし、直接お教え頂けるのであれば、こちらでもお願いいたします。