Interlock FCSR reads (but not other CSRs) when FPU is busy (#1574)

This was erroneously masking id_csr_en by id_ctrl.fp; these control
signals are mutually exclusive.  Fix that, and also optimize the stall
logic to avoid stalling on unrelated CSR accesses.