Dear Vahid,
I don’t think I can offer much advice without knowing more about your (one of a kind) TMD. I would guess it would be easiest to start with the existing TMD submodel of ServoDyn and modify it as necessary for your technology.
Best regards,