Add THD function