Add Katoco motor control code with a refactor