Pd controller combined with disturbance rejection at joint