Pidaf, pid with acceleration and friction compensation