optionally use plugin FK instead of TF FK

applied patch from here: https://code.ros.org/trac/ros-pkg/ticket/5586