Set the link name on constraints when saving an end effector goal

Right now it seems that in the RViz plugin when you save an end effector goal to the database it doesn't actually set the link_name field of the constraints. This fixes that.