Removed check_nodes to nao_smach_utils