parallel gripper tested

[mikeferguson]

• tested and working, with fixes:
• fix segfault when no active goal
• update documentation to note new parameter
• add missing initialization of PID