Wrapped PD control into PDTone library