summaryrefslogtreecommitdiffstats
path: root/drivers/edac/i5100_edac.c
diff options
context:
space:
mode:
authorArthur Jones <ajones@riverbed.com>2008-07-25 10:49:08 +0200
committerLinus Torvalds <torvalds@linux-foundation.org>2008-07-25 19:53:48 +0200
commitb238e57723a6fb2c365fc35de5d7c48ccf9300cd (patch)
tree5dd7fc42abedd6c5168b3f375b5a67de69305e9d /drivers/edac/i5100_edac.c
parentedac: i5100 fix unmask ecc bits (diff)
downloadlinux-b238e57723a6fb2c365fc35de5d7c48ccf9300cd.tar.xz
linux-b238e57723a6fb2c365fc35de5d7c48ccf9300cd.zip
edac: i5100: cleanup
Some code cleanliness issues found by Andrew Morton (thanks!) which should not affect functionality, but which should help make the code more maintainable. In particular, we now: * convert all #define's w/ a parameter to static inlines * use 1UL rather than 1ULL when calculating an unsigned long * use pci_disable_device The resulting code is tested and seems to work fine... Signed-off-by: Arthur Jones <ajones@riverbed.com> Cc: Doug Thompson <dougthompson@xmission.com> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
Diffstat (limited to '')
-rw-r--r--drivers/edac/i5100_edac.c396
1 files changed, 261 insertions, 135 deletions
diff --git a/drivers/edac/i5100_edac.c b/drivers/edac/i5100_edac.c
index d85e7992eb6a..22db05a67bfb 100644
--- a/drivers/edac/i5100_edac.c
+++ b/drivers/edac/i5100_edac.c
@@ -21,36 +21,19 @@
#include "edac_core.h"
-/* register addresses and bit field accessors... */
+/* register addresses */
/* device 16, func 1 */
#define I5100_MC 0x40 /* Memory Control Register */
-#define I5100_MC_ERRDETEN(a) ((a) >> 5 & 1)
#define I5100_MS 0x44 /* Memory Status Register */
#define I5100_SPDDATA 0x48 /* Serial Presence Detect Status Reg */
-#define I5100_SPDDATA_RDO(a) ((a) >> 15 & 1)
-#define I5100_SPDDATA_SBE(a) ((a) >> 13 & 1)
-#define I5100_SPDDATA_BUSY(a) ((a) >> 12 & 1)
-#define I5100_SPDDATA_DATA(a) ((a) & ((1 << 8) - 1))
#define I5100_SPDCMD 0x4c /* Serial Presence Detect Command Reg */
-#define I5100_SPDCMD_DTI(a) (((a) & ((1 << 4) - 1)) << 28)
-#define I5100_SPDCMD_CKOVRD(a) (((a) & 1) << 27)
-#define I5100_SPDCMD_SA(a) (((a) & ((1 << 3) - 1)) << 24)
-#define I5100_SPDCMD_BA(a) (((a) & ((1 << 8) - 1)) << 16)
-#define I5100_SPDCMD_DATA(a) (((a) & ((1 << 8) - 1)) << 8)
-#define I5100_SPDCMD_CMD(a) ((a) & 1)
#define I5100_TOLM 0x6c /* Top of Low Memory */
-#define I5100_TOLM_TOLM(a) ((a) >> 12 & ((1 << 4) - 1))
#define I5100_MIR0 0x80 /* Memory Interleave Range 0 */
#define I5100_MIR1 0x84 /* Memory Interleave Range 1 */
#define I5100_AMIR_0 0x8c /* Adjusted Memory Interleave Range 0 */
#define I5100_AMIR_1 0x90 /* Adjusted Memory Interleave Range 1 */
-#define I5100_MIR_LIMIT(a) ((a) >> 4 & ((1 << 12) - 1))
-#define I5100_MIR_WAY1(a) ((a) >> 1 & 1)
-#define I5100_MIR_WAY0(a) ((a) & 1)
#define I5100_FERR_NF_MEM 0xa0 /* MC First Non Fatal Errors */
-#define I5100_FERR_NF_MEM_CHAN_INDX(a) ((a) >> 28 & 1)
-#define I5100_FERR_NF_MEM_SPD_MASK (1 << 18)
#define I5100_FERR_NF_MEM_M16ERR_MASK (1 << 16)
#define I5100_FERR_NF_MEM_M15ERR_MASK (1 << 15)
#define I5100_FERR_NF_MEM_M14ERR_MASK (1 << 14)
@@ -72,47 +55,214 @@
I5100_FERR_NF_MEM_M5ERR_MASK | \
I5100_FERR_NF_MEM_M4ERR_MASK | \
I5100_FERR_NF_MEM_M1ERR_MASK)
-#define I5100_FERR_NF_MEM_ANY(a) ((a) & I5100_FERR_NF_MEM_ANY_MASK)
#define I5100_NERR_NF_MEM 0xa4 /* MC Next Non-Fatal Errors */
-#define I5100_NERR_NF_MEM_ANY(a) I5100_FERR_NF_MEM_ANY(a)
#define I5100_EMASK_MEM 0xa8 /* MC Error Mask Register */
/* device 21 and 22, func 0 */
#define I5100_MTR_0 0x154 /* Memory Technology Registers 0-3 */
#define I5100_DMIR 0x15c /* DIMM Interleave Range */
-#define I5100_DMIR_LIMIT(a) ((a) >> 16 & ((1 << 11) - 1))
-#define I5100_DMIR_RANK(a, i) ((a) >> (4 * i) & ((1 << 2) - 1))
-#define I5100_MTR_4 0x1b0 /* Memory Technology Registers 4,5 */
-#define I5100_MTR_PRESENT(a) ((a) >> 10 & 1)
-#define I5100_MTR_ETHROTTLE(a) ((a) >> 9 & 1)
-#define I5100_MTR_WIDTH(a) ((a) >> 8 & 1)
-#define I5100_MTR_NUMBANK(a) ((a) >> 6 & 1)
-#define I5100_MTR_NUMROW(a) ((a) >> 2 & ((1 << 2) - 1))
-#define I5100_MTR_NUMCOL(a) ((a) & ((1 << 2) - 1))
#define I5100_VALIDLOG 0x18c /* Valid Log Markers */
-#define I5100_VALIDLOG_REDMEMVALID(a) ((a) >> 2 & 1)
-#define I5100_VALIDLOG_RECMEMVALID(a) ((a) >> 1 & 1)
-#define I5100_VALIDLOG_NRECMEMVALID(a) ((a) & 1)
#define I5100_NRECMEMA 0x190 /* Non-Recoverable Memory Error Log Reg A */
-#define I5100_NRECMEMA_MERR(a) ((a) >> 15 & ((1 << 5) - 1))
-#define I5100_NRECMEMA_BANK(a) ((a) >> 12 & ((1 << 3) - 1))
-#define I5100_NRECMEMA_RANK(a) ((a) >> 8 & ((1 << 3) - 1))
-#define I5100_NRECMEMA_DM_BUF_ID(a) ((a) & ((1 << 8) - 1))
#define I5100_NRECMEMB 0x194 /* Non-Recoverable Memory Error Log Reg B */
-#define I5100_NRECMEMB_CAS(a) ((a) >> 16 & ((1 << 13) - 1))
-#define I5100_NRECMEMB_RAS(a) ((a) & ((1 << 16) - 1))
#define I5100_REDMEMA 0x198 /* Recoverable Memory Data Error Log Reg A */
-#define I5100_REDMEMA_SYNDROME(a) (a)
#define I5100_REDMEMB 0x19c /* Recoverable Memory Data Error Log Reg B */
-#define I5100_REDMEMB_ECC_LOCATOR(a) ((a) & ((1 << 18) - 1))
#define I5100_RECMEMA 0x1a0 /* Recoverable Memory Error Log Reg A */
-#define I5100_RECMEMA_MERR(a) I5100_NRECMEMA_MERR(a)
-#define I5100_RECMEMA_BANK(a) I5100_NRECMEMA_BANK(a)
-#define I5100_RECMEMA_RANK(a) I5100_NRECMEMA_RANK(a)
-#define I5100_RECMEMA_DM_BUF_ID(a) I5100_NRECMEMA_DM_BUF_ID(a)
#define I5100_RECMEMB 0x1a4 /* Recoverable Memory Error Log Reg B */
-#define I5100_RECMEMB_CAS(a) I5100_NRECMEMB_CAS(a)
-#define I5100_RECMEMB_RAS(a) I5100_NRECMEMB_RAS(a)
+#define I5100_MTR_4 0x1b0 /* Memory Technology Registers 4,5 */
+
+/* bit field accessors */
+
+static inline u32 i5100_mc_errdeten(u32 mc)
+{
+ return mc >> 5 & 1;
+}
+
+static inline u16 i5100_spddata_rdo(u16 a)
+{
+ return a >> 15 & 1;
+}
+
+static inline u16 i5100_spddata_sbe(u16 a)
+{
+ return a >> 13 & 1;
+}
+
+static inline u16 i5100_spddata_busy(u16 a)
+{
+ return a >> 12 & 1;
+}
+
+static inline u16 i5100_spddata_data(u16 a)
+{
+ return a & ((1 << 8) - 1);
+}
+
+static inline u32 i5100_spdcmd_create(u32 dti, u32 ckovrd, u32 sa, u32 ba,
+ u32 data, u32 cmd)
+{
+ return ((dti & ((1 << 4) - 1)) << 28) |
+ ((ckovrd & 1) << 27) |
+ ((sa & ((1 << 3) - 1)) << 24) |
+ ((ba & ((1 << 8) - 1)) << 16) |
+ ((data & ((1 << 8) - 1)) << 8) |
+ (cmd & 1);
+}
+
+static inline u16 i5100_tolm_tolm(u16 a)
+{
+ return a >> 12 & ((1 << 4) - 1);
+}
+
+static inline u16 i5100_mir_limit(u16 a)
+{
+ return a >> 4 & ((1 << 12) - 1);
+}
+
+static inline u16 i5100_mir_way1(u16 a)
+{
+ return a >> 1 & 1;
+}
+
+static inline u16 i5100_mir_way0(u16 a)
+{
+ return a & 1;
+}
+
+static inline u32 i5100_ferr_nf_mem_chan_indx(u32 a)
+{
+ return a >> 28 & 1;
+}
+
+static inline u32 i5100_ferr_nf_mem_any(u32 a)
+{
+ return a & I5100_FERR_NF_MEM_ANY_MASK;
+}
+
+static inline u32 i5100_nerr_nf_mem_any(u32 a)
+{
+ return i5100_ferr_nf_mem_any(a);
+}
+
+static inline u32 i5100_dmir_limit(u32 a)
+{
+ return a >> 16 & ((1 << 11) - 1);
+}
+
+static inline u32 i5100_dmir_rank(u32 a, u32 i)
+{
+ return a >> (4 * i) & ((1 << 2) - 1);
+}
+
+static inline u16 i5100_mtr_present(u16 a)
+{
+ return a >> 10 & 1;
+}
+
+static inline u16 i5100_mtr_ethrottle(u16 a)
+{
+ return a >> 9 & 1;
+}
+
+static inline u16 i5100_mtr_width(u16 a)
+{
+ return a >> 8 & 1;
+}
+
+static inline u16 i5100_mtr_numbank(u16 a)
+{
+ return a >> 6 & 1;
+}
+
+static inline u16 i5100_mtr_numrow(u16 a)
+{
+ return a >> 2 & ((1 << 2) - 1);
+}
+
+static inline u16 i5100_mtr_numcol(u16 a)
+{
+ return a & ((1 << 2) - 1);
+}
+
+
+static inline u32 i5100_validlog_redmemvalid(u32 a)
+{
+ return a >> 2 & 1;
+}
+
+static inline u32 i5100_validlog_recmemvalid(u32 a)
+{
+ return a >> 1 & 1;
+}
+
+static inline u32 i5100_validlog_nrecmemvalid(u32 a)
+{
+ return a & 1;
+}
+
+static inline u32 i5100_nrecmema_merr(u32 a)
+{
+ return a >> 15 & ((1 << 5) - 1);
+}
+
+static inline u32 i5100_nrecmema_bank(u32 a)
+{
+ return a >> 12 & ((1 << 3) - 1);
+}
+
+static inline u32 i5100_nrecmema_rank(u32 a)
+{
+ return a >> 8 & ((1 << 3) - 1);
+}
+
+static inline u32 i5100_nrecmema_dm_buf_id(u32 a)
+{
+ return a & ((1 << 8) - 1);
+}
+
+static inline u32 i5100_nrecmemb_cas(u32 a)
+{
+ return a >> 16 & ((1 << 13) - 1);
+}
+
+static inline u32 i5100_nrecmemb_ras(u32 a)
+{
+ return a & ((1 << 16) - 1);
+}
+
+static inline u32 i5100_redmemb_ecc_locator(u32 a)
+{
+ return a & ((1 << 18) - 1);
+}
+
+static inline u32 i5100_recmema_merr(u32 a)
+{
+ return i5100_nrecmema_merr(a);
+}
+
+static inline u32 i5100_recmema_bank(u32 a)
+{
+ return i5100_nrecmema_bank(a);
+}
+
+static inline u32 i5100_recmema_rank(u32 a)
+{
+ return i5100_nrecmema_rank(a);
+}
+
+static inline u32 i5100_recmema_dm_buf_id(u32 a)
+{
+ return i5100_nrecmema_dm_buf_id(a);
+}
+
+static inline u32 i5100_recmemb_cas(u32 a)
+{
+ return i5100_nrecmemb_cas(a);
+}
+
+static inline u32 i5100_recmemb_ras(u32 a)
+{
+ return i5100_nrecmemb_ras(a);
+}
/* some generic limits */
#define I5100_MAX_RANKS_PER_CTLR 6
@@ -189,42 +339,9 @@ static int i5100_rank_to_slot(const struct mem_ctl_info *mci,
return -1;
}
-/*
- * The processor bus memory addresses are broken into three
- * pieces, whereas the controller addresses are contiguous.
- *
- * here we map from the controller address space to the
- * processor address space:
- *
- * Processor Address Space
- * +-----------------------------+
- * | |
- * | "high" memory addresses |
- * | |
- * +-----------------------------+ <- 4GB on the i5100
- * | |
- * | other non-memory addresses |
- * | |
- * +-----------------------------+ <- top of low memory
- * | |
- * | "low" memory addresses |
- * | |
- * +-----------------------------+
- */
-static unsigned long i5100_ctl_page_to_phys(struct mem_ctl_info *mci,
- unsigned long cntlr_addr)
-{
- const struct i5100_priv *priv = mci->pvt_info;
-
- if (cntlr_addr < priv->tolm)
- return cntlr_addr;
-
- return (1ULL << 32) + (cntlr_addr - priv->tolm);
-}
-
static const char *i5100_err_msg(unsigned err)
{
- const char *merrs[] = {
+ static const char *merrs[] = {
"unknown", /* 0 */
"uncorrectable data ECC on replay", /* 1 */
"unknown", /* 2 */
@@ -341,24 +458,24 @@ static void i5100_read_log(struct mem_ctl_info *mci, int ctlr,
pci_read_config_dword(pdev, I5100_VALIDLOG, &dw);
- if (I5100_VALIDLOG_REDMEMVALID(dw)) {
+ if (i5100_validlog_redmemvalid(dw)) {
pci_read_config_dword(pdev, I5100_REDMEMA, &dw2);
- syndrome = I5100_REDMEMA_SYNDROME(dw2);
+ syndrome = dw2;
pci_read_config_dword(pdev, I5100_REDMEMB, &dw2);
- ecc_loc = I5100_REDMEMB_ECC_LOCATOR(dw2);
+ ecc_loc = i5100_redmemb_ecc_locator(dw2);
}
- if (I5100_VALIDLOG_RECMEMVALID(dw)) {
+ if (i5100_validlog_recmemvalid(dw)) {
const char *msg;
pci_read_config_dword(pdev, I5100_RECMEMA, &dw2);
- merr = I5100_RECMEMA_MERR(dw2);
- bank = I5100_RECMEMA_BANK(dw2);
- rank = I5100_RECMEMA_RANK(dw2);
+ merr = i5100_recmema_merr(dw2);
+ bank = i5100_recmema_bank(dw2);
+ rank = i5100_recmema_rank(dw2);
pci_read_config_dword(pdev, I5100_RECMEMB, &dw2);
- cas = I5100_RECMEMB_CAS(dw2);
- ras = I5100_RECMEMB_RAS(dw2);
+ cas = i5100_recmemb_cas(dw2);
+ ras = i5100_recmemb_ras(dw2);
/* FIXME: not really sure if this is what merr is...
*/
@@ -370,17 +487,17 @@ static void i5100_read_log(struct mem_ctl_info *mci, int ctlr,
i5100_handle_ce(mci, ctlr, bank, rank, syndrome, cas, ras, msg);
}
- if (I5100_VALIDLOG_NRECMEMVALID(dw)) {
+ if (i5100_validlog_nrecmemvalid(dw)) {
const char *msg;
pci_read_config_dword(pdev, I5100_NRECMEMA, &dw2);
- merr = I5100_NRECMEMA_MERR(dw2);
- bank = I5100_NRECMEMA_BANK(dw2);
- rank = I5100_NRECMEMA_RANK(dw2);
+ merr = i5100_nrecmema_merr(dw2);
+ bank = i5100_nrecmema_bank(dw2);
+ rank = i5100_nrecmema_rank(dw2);
pci_read_config_dword(pdev, I5100_NRECMEMB, &dw2);
- cas = I5100_NRECMEMB_CAS(dw2);
- ras = I5100_NRECMEMB_RAS(dw2);
+ cas = i5100_nrecmemb_cas(dw2);
+ ras = i5100_nrecmemb_ras(dw2);
/* FIXME: not really sure if this is what merr is...
*/
@@ -402,7 +519,7 @@ static void i5100_check_error(struct mem_ctl_info *mci)
pci_read_config_dword(priv->mc, I5100_FERR_NF_MEM, &dw);
- if (I5100_FERR_NF_MEM_ANY(dw)) {
+ if (i5100_ferr_nf_mem_any(dw)) {
u32 dw2;
pci_read_config_dword(priv->mc, I5100_NERR_NF_MEM, &dw2);
@@ -411,9 +528,9 @@ static void i5100_check_error(struct mem_ctl_info *mci)
dw2);
pci_write_config_dword(priv->mc, I5100_FERR_NF_MEM, dw);
- i5100_read_log(mci, I5100_FERR_NF_MEM_CHAN_INDX(dw),
- I5100_FERR_NF_MEM_ANY(dw),
- I5100_NERR_NF_MEM_ANY(dw2));
+ i5100_read_log(mci, i5100_ferr_nf_mem_chan_indx(dw),
+ i5100_ferr_nf_mem_any(dw),
+ i5100_nerr_nf_mem_any(dw2));
}
}
@@ -476,12 +593,12 @@ static void __devinit i5100_init_mtr(struct mem_ctl_info *mci)
pci_read_config_word(pdev, addr, &w);
- priv->mtr[i][j].present = I5100_MTR_PRESENT(w);
- priv->mtr[i][j].ethrottle = I5100_MTR_ETHROTTLE(w);
- priv->mtr[i][j].width = 4 + 4 * I5100_MTR_WIDTH(w);
- priv->mtr[i][j].numbank = 2 + I5100_MTR_NUMBANK(w);
- priv->mtr[i][j].numrow = 13 + I5100_MTR_NUMROW(w);
- priv->mtr[i][j].numcol = 10 + I5100_MTR_NUMCOL(w);
+ priv->mtr[i][j].present = i5100_mtr_present(w);
+ priv->mtr[i][j].ethrottle = i5100_mtr_ethrottle(w);
+ priv->mtr[i][j].width = 4 + 4 * i5100_mtr_width(w);
+ priv->mtr[i][j].numbank = 2 + i5100_mtr_numbank(w);
+ priv->mtr[i][j].numrow = 13 + i5100_mtr_numrow(w);
+ priv->mtr[i][j].numcol = 10 + i5100_mtr_numcol(w);
}
}
}
@@ -495,35 +612,30 @@ static int i5100_read_spd_byte(const struct mem_ctl_info *mci,
{
struct i5100_priv *priv = mci->pvt_info;
u16 w;
- u32 dw;
unsigned long et;
pci_read_config_word(priv->mc, I5100_SPDDATA, &w);
- if (I5100_SPDDATA_BUSY(w))
+ if (i5100_spddata_busy(w))
return -1;
- dw = I5100_SPDCMD_DTI(0xa) |
- I5100_SPDCMD_CKOVRD(1) |
- I5100_SPDCMD_SA(ch * 4 + slot) |
- I5100_SPDCMD_BA(addr) |
- I5100_SPDCMD_DATA(0) |
- I5100_SPDCMD_CMD(0);
- pci_write_config_dword(priv->mc, I5100_SPDCMD, dw);
+ pci_write_config_dword(priv->mc, I5100_SPDCMD,
+ i5100_spdcmd_create(0xa, 1, ch * 4 + slot, addr,
+ 0, 0));
/* wait up to 100ms */
et = jiffies + HZ / 10;
udelay(100);
while (1) {
pci_read_config_word(priv->mc, I5100_SPDDATA, &w);
- if (!I5100_SPDDATA_BUSY(w))
+ if (!i5100_spddata_busy(w))
break;
udelay(100);
}
- if (!I5100_SPDDATA_RDO(w) || I5100_SPDDATA_SBE(w))
+ if (!i5100_spddata_rdo(w) || i5100_spddata_sbe(w))
return -1;
- *byte = I5100_SPDDATA_DATA(w);
+ *byte = i5100_spddata_data(w);
return 0;
}
@@ -591,17 +703,17 @@ static void __devinit i5100_init_interleaving(struct pci_dev *pdev,
int i;
pci_read_config_word(pdev, I5100_TOLM, &w);
- priv->tolm = (u64) I5100_TOLM_TOLM(w) * 256 * 1024 * 1024;
+ priv->tolm = (u64) i5100_tolm_tolm(w) * 256 * 1024 * 1024;
pci_read_config_word(pdev, I5100_MIR0, &w);
- priv->mir[0].limit = (u64) I5100_MIR_LIMIT(w) << 28;
- priv->mir[0].way[1] = I5100_MIR_WAY1(w);
- priv->mir[0].way[0] = I5100_MIR_WAY0(w);
+ priv->mir[0].limit = (u64) i5100_mir_limit(w) << 28;
+ priv->mir[0].way[1] = i5100_mir_way1(w);
+ priv->mir[0].way[0] = i5100_mir_way0(w);
pci_read_config_word(pdev, I5100_MIR1, &w);
- priv->mir[1].limit = (u64) I5100_MIR_LIMIT(w) << 28;
- priv->mir[1].way[1] = I5100_MIR_WAY1(w);
- priv->mir[1].way[0] = I5100_MIR_WAY0(w);
+ priv->mir[1].limit = (u64) i5100_mir_limit(w) << 28;
+ priv->mir[1].way[1] = i5100_mir_way1(w);
+ priv->mir[1].way[0] = i5100_mir_way0(w);
pci_read_config_word(pdev, I5100_AMIR_0, &w);
priv->amir[0] = w;
@@ -617,10 +729,10 @@ static void __devinit i5100_init_interleaving(struct pci_dev *pdev,
pci_read_config_dword(mms[i], I5100_DMIR + j * 4, &dw);
priv->dmir[i][j].limit =
- (u64) I5100_DMIR_LIMIT(dw) << 28;
+ (u64) i5100_dmir_limit(dw) << 28;
for (k = 0; k < I5100_MAX_RANKS_PER_DIMM; k++)
priv->dmir[i][j].rank[k] =
- I5100_DMIR_RANK(dw, k);
+ i5100_dmir_rank(dw, k);
}
}
@@ -693,10 +805,10 @@ static int __devinit i5100_init_one(struct pci_dev *pdev,
/* ECC enabled? */
pci_read_config_dword(pdev, I5100_MC, &dw);
- if (!I5100_MC_ERRDETEN(dw)) {
+ if (!i5100_mc_errdeten(dw)) {
printk(KERN_INFO "i5100_edac: ECC not enabled.\n");
ret = -ENODEV;
- goto bail;
+ goto bail_pdev;
}
/* figure out how many ranks, from strapped state of 48GB_Mode input */
@@ -707,7 +819,7 @@ static int __devinit i5100_init_one(struct pci_dev *pdev,
/* FIXME: get 6 ranks / controller to work - need hw... */
printk(KERN_INFO "i5100_edac: unsupported configuration.\n");
ret = -ENODEV;
- goto bail;
+ goto bail_pdev;
}
/* enable error reporting... */
@@ -718,8 +830,10 @@ static int __devinit i5100_init_one(struct pci_dev *pdev,
/* device 21, func 0, Channel 0 Memory Map, Error Flag/Mask, etc... */
ch0mm = pci_get_device_func(PCI_VENDOR_ID_INTEL,
PCI_DEVICE_ID_INTEL_5100_21, 0);
- if (!ch0mm)
- return -ENODEV;
+ if (!ch0mm) {
+ ret = -ENODEV;
+ goto bail_pdev;
+ }
rc = pci_enable_device(ch0mm);
if (rc < 0) {
@@ -732,7 +846,7 @@ static int __devinit i5100_init_one(struct pci_dev *pdev,
PCI_DEVICE_ID_INTEL_5100_22, 0);
if (!ch1mm) {
ret = -ENODEV;
- goto bail_ch0;
+ goto bail_disable_ch0;
}
rc = pci_enable_device(ch1mm);
@@ -744,7 +858,7 @@ static int __devinit i5100_init_one(struct pci_dev *pdev,
mci = edac_mc_alloc(sizeof(*priv), ranksperch * 2, 1, 0);
if (!mci) {
ret = -ENOMEM;
- goto bail_ch1;
+ goto bail_disable_ch1;
}
mci->dev = &pdev->dev;
@@ -765,7 +879,7 @@ static int __devinit i5100_init_one(struct pci_dev *pdev,
mci->mod_ver = "not versioned";
mci->ctl_name = "i5100";
mci->dev_name = pci_name(pdev);
- mci->ctl_page_to_phys = i5100_ctl_page_to_phys;
+ mci->ctl_page_to_phys = NULL;
mci->edac_check = i5100_check_error;
@@ -786,17 +900,26 @@ static int __devinit i5100_init_one(struct pci_dev *pdev,
goto bail_mc;
}
- goto bail;
+ return ret;
bail_mc:
edac_mc_free(mci);
+bail_disable_ch1:
+ pci_disable_device(ch1mm);
+
bail_ch1:
pci_dev_put(ch1mm);
+bail_disable_ch0:
+ pci_disable_device(ch0mm);
+
bail_ch0:
pci_dev_put(ch0mm);
+bail_pdev:
+ pci_disable_device(pdev);
+
bail:
return ret;
}
@@ -812,6 +935,9 @@ static void __devexit i5100_remove_one(struct pci_dev *pdev)
return;
priv = mci->pvt_info;
+ pci_disable_device(pdev);
+ pci_disable_device(priv->ch0mm);
+ pci_disable_device(priv->ch1mm);
pci_dev_put(priv->ch0mm);
pci_dev_put(priv->ch1mm);