New P+D controller for collocated use and effort output