subscribe to fsm_state topic

[kochaika]

• create sub...
• create callback function
• add some logs for (print)
• save last state + time_stamp to self...

[TatyanaBerlenko]

#9