Initial commit of wsg_50_grasp_controller pkg.
First controller version.
Working version, after first debuging.