Du musst unten noch das
Gosub Clear_scr durch ein einfaches
Cls
ersetzen, da du ein anderes LCD benutzt.

Außerdem denke ich, dass du den Timer_startwert etwa auf 156 erhöhen solltest, damit der Timer ungefähr im 10KHz Takt überläuft.

Gruß

Rolf