Imported rexos_statemachine into ROSDev