SMACH C++ counterpart

edit

I was looking for a way to use SMACH in C++ but it seems that there is no C++ version of SMACH. I'm currently having some nodes written in python and some written in C++. The Python nodes all use SMACH and I mainly want it for visualizing the internal states of my robot. I also want my C++ components to be in shown in that visualization and I also want to use the hierarchical part of SMACH. Is there any implementation somewhere which can achieves this? I'm mainly interested in the visualization of internal states, writing a state machine is not that of a problem, but I don't want to spend any time on the visual part.