Fixed bug in RevoluteJointModel::distance() giving large negative numbers.
Merge pull request #174 from ros-planning/continuous-joint-distance

Fixed bug in RevoluteJointModel::distance() giving large negative numbers.