Update bt_action_node.hpp

During testing using a fork of this code we found an edge case where the BT crashes if there is an issue with the goal_handle.

Weirdly the Action Server received the action properly and executes it. But for some reason the code crashes here.

This small fix should avoid the crashing while still exposing the issue with the Action Server communication