em400: cpu_step() reorganize