Creating the MoveIt! IKFast plugin for the ABB-IRB6640 robot