You should check out http://philserver.bplaced.net/fbe/ used by Team ViGIR in DRC. http://ieeexplore.ieee.org/document/7487442/ --- [Visit Topic](https://discourse.ros.org/t/smach-projects/2397/12) or reply to this email to respond.