Staging: sep: rework write_register/read_register