Fix reserved CSR write

Created by: Moschn

Fix illegal write to PMPCFG. Reported by Flavien Solt (@flaviens)

Supersedes #820

I also found a way to simplify and clarify the code for the CSR read and write of PMPADDR. Should be functionally the same as before.