support failure plan

support failure plan and execute smach with failure recovery support.