Unwinding when planToNamedConfiguration for fully continuous joints #296
Description
If we plan to a specific configuration, we do not currently take into account that some joints are fully continuous, and have multiple values for identical positions. Thus, if we are 2*pi away, the robot will move that joint a full revolution to get to the specified configuration.