fixed avoid joint limits bug where J weight applied twice
moved ik routines into ik/ directory
Added singularity avoidance constraint
Added joint velocity limit constraint
Corrected behavior in avoid_singularities constraint
Added checkStatus methods to all current constraints