split CiA402 defines and state machine implementation
update motor config and init functions