better assert
Add ComputeIk2 to ikfast.h in order to pass in openrave manipulator pointer