Add generic Can function to fsm