jhu-dvrk / sawIntuitiveResearchKit

cisst/SAW stack for the da Vinci Research Kit (dVRK)
https://github.com/jhu-dvrk/sawIntuitiveResearchKit/wiki
118 stars 68 forks source link

Add "rate" check on PID to make sure consecutive servo commands are reasonable #121

Open adeguet1 opened 5 years ago

adeguet1 commented 5 years ago

The goal is to make sure the trajectories requested by the user are somewhat continuous. We might even be able to use the max velocity used for joint trajectory generation (maybe with extra 20% to avoid false negative). For now, I would replicate implementation for PID tracking error, i.e.: