[wait_action] Fix for review bug

@hawesie and @BFALacerda will have to decide if this is to be merged. It is a fix for a bug we had during the review where the robot failed to call the wait_action when waiting or charging.