[roseus_smach] fix state-machine.l

[Naoki-Hiraoka]

state-machine.lを使用しようとしたところ、

• active-stateが複数ありかつsubmachineがある場合にうまく動かない
• リストの集合処理が正しくない
• :execute-implはリストを返すことが期待されているが返さないことがある
• :reset-stateが呼ばれるタイミングが不明確
• active-stateが複数ある場合にどれか一つがgoalに到達すると終了してしまう

等の不便があったため、修正しました。

いずれテストを書こうと思います。

[k-okada]

@Naoki-Hiraoka https://github.com/jsk-ros-pkg/jsk_roseus/pull/657 を見てください． df9b486　のお陰で https://github.com/jsk-ros-pkg/jsk_roseus/pull/657/commits/bc79483cbd381a55682470b829bd2da12971d4d0 が動くのようになったのですが， その一方で， roseus state-machine-ros-sample.l "(exec-smach-nested)" をすると，sub container に入ると １）https://github.com/jsk-ros-pkg/jsk_roseus/blob/070dfac76d40cad9c3926dbf79667f9fdda3c607/roseus_smach/src/state-machine-utils.l#L43 ？？の部分のsleepが聞かずに一瞬で状態が変化する ２）現在の状態が/server_name/smach/container_status にpublish されず smach_viewer.py に表示されない という問題が発生しています．