Resolve "Add stop-on-force-threshold behavior to TaskSpaceDMPController"

Closes #26

See merge request !45