mips: optimize CP0 read/write code