Created nao_smach_utils package with some SMACH nodes