WIP: tdc001: add missing commands and msg handling