Here is the firmware and schematic as promised.
Program is compiled with Mikropascal Pro for AVR.
Schematic and board are done in Eagle 5.8.0.
I am a software engineer so please forgive my mistakes in the schematic.
I am open to any suggestion or remark!
I will come back later explaining functionality and where and how the PID process is involved.
Mihai.