dynamics_solver: fix crashbug

Ignore joint that does not exist (including the virtual joint if it is part of
the group).
Merge pull request #162 from acornacorn/fix_dynamic_solver

dynamics_solver: fix crashbug