canopen code compiles, but not tested/integrated yet