Rework state switching II

[jkrumow]

• each node knows its path inside the state machine hierarchy when it is added to the hierarchy
• find LCA from source state's path and destination state's
• switches to next sub state machine

[jkrumow]

Ready for testing.