Implemented mfsr and mtsr instructions