Merge pull request #15 from Tectu/master

Merge Tectu Changes
TDISP cleanup

Seperate High level and low level code better
Implement tdispControl
Cleanup
TDISP merge - NOT TESTED!!!