I generated a node that is excatly the same position controller node but I modifed it to accept a feedback force. This node checks for the robot battery and period of recieved data. I generated another copy for the launch files and config files for the new node.