mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
1124 lines
27 KiB
1124 lines
27 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* |
|
* Filename: core.c |
|
* |
|
* Authors: Joshua Morris <[email protected]> |
|
* Philip Kelleher <[email protected]> |
|
* |
|
* (C) Copyright 2013 IBM Corporation |
|
*/ |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/init.h> |
|
#include <linux/interrupt.h> |
|
#include <linux/module.h> |
|
#include <linux/pci.h> |
|
#include <linux/reboot.h> |
|
#include <linux/slab.h> |
|
#include <linux/bitops.h> |
|
#include <linux/delay.h> |
|
#include <linux/debugfs.h> |
|
#include <linux/seq_file.h> |
|
|
|
#include <linux/genhd.h> |
|
#include <linux/idr.h> |
|
|
|
#include "rsxx_priv.h" |
|
#include "rsxx_cfg.h" |
|
|
|
#define NO_LEGACY 0 |
|
#define SYNC_START_TIMEOUT (10 * 60) /* 10 minutes */ |
|
|
|
MODULE_DESCRIPTION("IBM Flash Adapter 900GB Full Height Device Driver"); |
|
MODULE_AUTHOR("Joshua Morris/Philip Kelleher, IBM"); |
|
MODULE_LICENSE("GPL"); |
|
MODULE_VERSION(DRIVER_VERSION); |
|
|
|
static unsigned int force_legacy = NO_LEGACY; |
|
module_param(force_legacy, uint, 0444); |
|
MODULE_PARM_DESC(force_legacy, "Force the use of legacy type PCI interrupts"); |
|
|
|
static unsigned int sync_start = 1; |
|
module_param(sync_start, uint, 0444); |
|
MODULE_PARM_DESC(sync_start, "On by Default: Driver load will not complete " |
|
"until the card startup has completed."); |
|
|
|
static DEFINE_IDA(rsxx_disk_ida); |
|
|
|
/* --------------------Debugfs Setup ------------------- */ |
|
|
|
static int rsxx_attr_pci_regs_show(struct seq_file *m, void *p) |
|
{ |
|
struct rsxx_cardinfo *card = m->private; |
|
|
|
seq_printf(m, "HWID 0x%08x\n", |
|
ioread32(card->regmap + HWID)); |
|
seq_printf(m, "SCRATCH 0x%08x\n", |
|
ioread32(card->regmap + SCRATCH)); |
|
seq_printf(m, "IER 0x%08x\n", |
|
ioread32(card->regmap + IER)); |
|
seq_printf(m, "IPR 0x%08x\n", |
|
ioread32(card->regmap + IPR)); |
|
seq_printf(m, "CREG_CMD 0x%08x\n", |
|
ioread32(card->regmap + CREG_CMD)); |
|
seq_printf(m, "CREG_ADD 0x%08x\n", |
|
ioread32(card->regmap + CREG_ADD)); |
|
seq_printf(m, "CREG_CNT 0x%08x\n", |
|
ioread32(card->regmap + CREG_CNT)); |
|
seq_printf(m, "CREG_STAT 0x%08x\n", |
|
ioread32(card->regmap + CREG_STAT)); |
|
seq_printf(m, "CREG_DATA0 0x%08x\n", |
|
ioread32(card->regmap + CREG_DATA0)); |
|
seq_printf(m, "CREG_DATA1 0x%08x\n", |
|
ioread32(card->regmap + CREG_DATA1)); |
|
seq_printf(m, "CREG_DATA2 0x%08x\n", |
|
ioread32(card->regmap + CREG_DATA2)); |
|
seq_printf(m, "CREG_DATA3 0x%08x\n", |
|
ioread32(card->regmap + CREG_DATA3)); |
|
seq_printf(m, "CREG_DATA4 0x%08x\n", |
|
ioread32(card->regmap + CREG_DATA4)); |
|
seq_printf(m, "CREG_DATA5 0x%08x\n", |
|
ioread32(card->regmap + CREG_DATA5)); |
|
seq_printf(m, "CREG_DATA6 0x%08x\n", |
|
ioread32(card->regmap + CREG_DATA6)); |
|
seq_printf(m, "CREG_DATA7 0x%08x\n", |
|
ioread32(card->regmap + CREG_DATA7)); |
|
seq_printf(m, "INTR_COAL 0x%08x\n", |
|
ioread32(card->regmap + INTR_COAL)); |
|
seq_printf(m, "HW_ERROR 0x%08x\n", |
|
ioread32(card->regmap + HW_ERROR)); |
|
seq_printf(m, "DEBUG0 0x%08x\n", |
|
ioread32(card->regmap + PCI_DEBUG0)); |
|
seq_printf(m, "DEBUG1 0x%08x\n", |
|
ioread32(card->regmap + PCI_DEBUG1)); |
|
seq_printf(m, "DEBUG2 0x%08x\n", |
|
ioread32(card->regmap + PCI_DEBUG2)); |
|
seq_printf(m, "DEBUG3 0x%08x\n", |
|
ioread32(card->regmap + PCI_DEBUG3)); |
|
seq_printf(m, "DEBUG4 0x%08x\n", |
|
ioread32(card->regmap + PCI_DEBUG4)); |
|
seq_printf(m, "DEBUG5 0x%08x\n", |
|
ioread32(card->regmap + PCI_DEBUG5)); |
|
seq_printf(m, "DEBUG6 0x%08x\n", |
|
ioread32(card->regmap + PCI_DEBUG6)); |
|
seq_printf(m, "DEBUG7 0x%08x\n", |
|
ioread32(card->regmap + PCI_DEBUG7)); |
|
seq_printf(m, "RECONFIG 0x%08x\n", |
|
ioread32(card->regmap + PCI_RECONFIG)); |
|
|
|
return 0; |
|
} |
|
|
|
static int rsxx_attr_stats_show(struct seq_file *m, void *p) |
|
{ |
|
struct rsxx_cardinfo *card = m->private; |
|
int i; |
|
|
|
for (i = 0; i < card->n_targets; i++) { |
|
seq_printf(m, "Ctrl %d CRC Errors = %d\n", |
|
i, card->ctrl[i].stats.crc_errors); |
|
seq_printf(m, "Ctrl %d Hard Errors = %d\n", |
|
i, card->ctrl[i].stats.hard_errors); |
|
seq_printf(m, "Ctrl %d Soft Errors = %d\n", |
|
i, card->ctrl[i].stats.soft_errors); |
|
seq_printf(m, "Ctrl %d Writes Issued = %d\n", |
|
i, card->ctrl[i].stats.writes_issued); |
|
seq_printf(m, "Ctrl %d Writes Failed = %d\n", |
|
i, card->ctrl[i].stats.writes_failed); |
|
seq_printf(m, "Ctrl %d Reads Issued = %d\n", |
|
i, card->ctrl[i].stats.reads_issued); |
|
seq_printf(m, "Ctrl %d Reads Failed = %d\n", |
|
i, card->ctrl[i].stats.reads_failed); |
|
seq_printf(m, "Ctrl %d Reads Retried = %d\n", |
|
i, card->ctrl[i].stats.reads_retried); |
|
seq_printf(m, "Ctrl %d Discards Issued = %d\n", |
|
i, card->ctrl[i].stats.discards_issued); |
|
seq_printf(m, "Ctrl %d Discards Failed = %d\n", |
|
i, card->ctrl[i].stats.discards_failed); |
|
seq_printf(m, "Ctrl %d DMA SW Errors = %d\n", |
|
i, card->ctrl[i].stats.dma_sw_err); |
|
seq_printf(m, "Ctrl %d DMA HW Faults = %d\n", |
|
i, card->ctrl[i].stats.dma_hw_fault); |
|
seq_printf(m, "Ctrl %d DMAs Cancelled = %d\n", |
|
i, card->ctrl[i].stats.dma_cancelled); |
|
seq_printf(m, "Ctrl %d SW Queue Depth = %d\n", |
|
i, card->ctrl[i].stats.sw_q_depth); |
|
seq_printf(m, "Ctrl %d HW Queue Depth = %d\n", |
|
i, atomic_read(&card->ctrl[i].stats.hw_q_depth)); |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static int rsxx_attr_stats_open(struct inode *inode, struct file *file) |
|
{ |
|
return single_open(file, rsxx_attr_stats_show, inode->i_private); |
|
} |
|
|
|
static int rsxx_attr_pci_regs_open(struct inode *inode, struct file *file) |
|
{ |
|
return single_open(file, rsxx_attr_pci_regs_show, inode->i_private); |
|
} |
|
|
|
static ssize_t rsxx_cram_read(struct file *fp, char __user *ubuf, |
|
size_t cnt, loff_t *ppos) |
|
{ |
|
struct rsxx_cardinfo *card = file_inode(fp)->i_private; |
|
char *buf; |
|
int st; |
|
|
|
buf = kzalloc(cnt, GFP_KERNEL); |
|
if (!buf) |
|
return -ENOMEM; |
|
|
|
st = rsxx_creg_read(card, CREG_ADD_CRAM + (u32)*ppos, cnt, buf, 1); |
|
if (!st) { |
|
if (copy_to_user(ubuf, buf, cnt)) |
|
st = -EFAULT; |
|
} |
|
kfree(buf); |
|
if (st) |
|
return st; |
|
*ppos += cnt; |
|
return cnt; |
|
} |
|
|
|
static ssize_t rsxx_cram_write(struct file *fp, const char __user *ubuf, |
|
size_t cnt, loff_t *ppos) |
|
{ |
|
struct rsxx_cardinfo *card = file_inode(fp)->i_private; |
|
char *buf; |
|
ssize_t st; |
|
|
|
buf = memdup_user(ubuf, cnt); |
|
if (IS_ERR(buf)) |
|
return PTR_ERR(buf); |
|
|
|
st = rsxx_creg_write(card, CREG_ADD_CRAM + (u32)*ppos, cnt, buf, 1); |
|
kfree(buf); |
|
if (st) |
|
return st; |
|
*ppos += cnt; |
|
return cnt; |
|
} |
|
|
|
static const struct file_operations debugfs_cram_fops = { |
|
.owner = THIS_MODULE, |
|
.read = rsxx_cram_read, |
|
.write = rsxx_cram_write, |
|
}; |
|
|
|
static const struct file_operations debugfs_stats_fops = { |
|
.owner = THIS_MODULE, |
|
.open = rsxx_attr_stats_open, |
|
.read = seq_read, |
|
.llseek = seq_lseek, |
|
.release = single_release, |
|
}; |
|
|
|
static const struct file_operations debugfs_pci_regs_fops = { |
|
.owner = THIS_MODULE, |
|
.open = rsxx_attr_pci_regs_open, |
|
.read = seq_read, |
|
.llseek = seq_lseek, |
|
.release = single_release, |
|
}; |
|
|
|
static void rsxx_debugfs_dev_new(struct rsxx_cardinfo *card) |
|
{ |
|
struct dentry *debugfs_stats; |
|
struct dentry *debugfs_pci_regs; |
|
struct dentry *debugfs_cram; |
|
|
|
card->debugfs_dir = debugfs_create_dir(card->gendisk->disk_name, NULL); |
|
if (IS_ERR_OR_NULL(card->debugfs_dir)) |
|
goto failed_debugfs_dir; |
|
|
|
debugfs_stats = debugfs_create_file("stats", 0444, |
|
card->debugfs_dir, card, |
|
&debugfs_stats_fops); |
|
if (IS_ERR_OR_NULL(debugfs_stats)) |
|
goto failed_debugfs_stats; |
|
|
|
debugfs_pci_regs = debugfs_create_file("pci_regs", 0444, |
|
card->debugfs_dir, card, |
|
&debugfs_pci_regs_fops); |
|
if (IS_ERR_OR_NULL(debugfs_pci_regs)) |
|
goto failed_debugfs_pci_regs; |
|
|
|
debugfs_cram = debugfs_create_file("cram", 0644, |
|
card->debugfs_dir, card, |
|
&debugfs_cram_fops); |
|
if (IS_ERR_OR_NULL(debugfs_cram)) |
|
goto failed_debugfs_cram; |
|
|
|
return; |
|
failed_debugfs_cram: |
|
debugfs_remove(debugfs_pci_regs); |
|
failed_debugfs_pci_regs: |
|
debugfs_remove(debugfs_stats); |
|
failed_debugfs_stats: |
|
debugfs_remove(card->debugfs_dir); |
|
failed_debugfs_dir: |
|
card->debugfs_dir = NULL; |
|
} |
|
|
|
/*----------------- Interrupt Control & Handling -------------------*/ |
|
|
|
static void rsxx_mask_interrupts(struct rsxx_cardinfo *card) |
|
{ |
|
card->isr_mask = 0; |
|
card->ier_mask = 0; |
|
} |
|
|
|
static void __enable_intr(unsigned int *mask, unsigned int intr) |
|
{ |
|
*mask |= intr; |
|
} |
|
|
|
static void __disable_intr(unsigned int *mask, unsigned int intr) |
|
{ |
|
*mask &= ~intr; |
|
} |
|
|
|
/* |
|
* NOTE: Disabling the IER will disable the hardware interrupt. |
|
* Disabling the ISR will disable the software handling of the ISR bit. |
|
* |
|
* Enable/Disable interrupt functions assume the card->irq_lock |
|
* is held by the caller. |
|
*/ |
|
void rsxx_enable_ier(struct rsxx_cardinfo *card, unsigned int intr) |
|
{ |
|
if (unlikely(card->halt) || |
|
unlikely(card->eeh_state)) |
|
return; |
|
|
|
__enable_intr(&card->ier_mask, intr); |
|
iowrite32(card->ier_mask, card->regmap + IER); |
|
} |
|
|
|
void rsxx_disable_ier(struct rsxx_cardinfo *card, unsigned int intr) |
|
{ |
|
if (unlikely(card->eeh_state)) |
|
return; |
|
|
|
__disable_intr(&card->ier_mask, intr); |
|
iowrite32(card->ier_mask, card->regmap + IER); |
|
} |
|
|
|
void rsxx_enable_ier_and_isr(struct rsxx_cardinfo *card, |
|
unsigned int intr) |
|
{ |
|
if (unlikely(card->halt) || |
|
unlikely(card->eeh_state)) |
|
return; |
|
|
|
__enable_intr(&card->isr_mask, intr); |
|
__enable_intr(&card->ier_mask, intr); |
|
iowrite32(card->ier_mask, card->regmap + IER); |
|
} |
|
void rsxx_disable_ier_and_isr(struct rsxx_cardinfo *card, |
|
unsigned int intr) |
|
{ |
|
if (unlikely(card->eeh_state)) |
|
return; |
|
|
|
__disable_intr(&card->isr_mask, intr); |
|
__disable_intr(&card->ier_mask, intr); |
|
iowrite32(card->ier_mask, card->regmap + IER); |
|
} |
|
|
|
static irqreturn_t rsxx_isr(int irq, void *pdata) |
|
{ |
|
struct rsxx_cardinfo *card = pdata; |
|
unsigned int isr; |
|
int handled = 0; |
|
int reread_isr; |
|
int i; |
|
|
|
spin_lock(&card->irq_lock); |
|
|
|
do { |
|
reread_isr = 0; |
|
|
|
if (unlikely(card->eeh_state)) |
|
break; |
|
|
|
isr = ioread32(card->regmap + ISR); |
|
if (isr == 0xffffffff) { |
|
/* |
|
* A few systems seem to have an intermittent issue |
|
* where PCI reads return all Fs, but retrying the read |
|
* a little later will return as expected. |
|
*/ |
|
dev_info(CARD_TO_DEV(card), |
|
"ISR = 0xFFFFFFFF, retrying later\n"); |
|
break; |
|
} |
|
|
|
isr &= card->isr_mask; |
|
if (!isr) |
|
break; |
|
|
|
for (i = 0; i < card->n_targets; i++) { |
|
if (isr & CR_INTR_DMA(i)) { |
|
if (card->ier_mask & CR_INTR_DMA(i)) { |
|
rsxx_disable_ier(card, CR_INTR_DMA(i)); |
|
reread_isr = 1; |
|
} |
|
queue_work(card->ctrl[i].done_wq, |
|
&card->ctrl[i].dma_done_work); |
|
handled++; |
|
} |
|
} |
|
|
|
if (isr & CR_INTR_CREG) { |
|
queue_work(card->creg_ctrl.creg_wq, |
|
&card->creg_ctrl.done_work); |
|
handled++; |
|
} |
|
|
|
if (isr & CR_INTR_EVENT) { |
|
queue_work(card->event_wq, &card->event_work); |
|
rsxx_disable_ier_and_isr(card, CR_INTR_EVENT); |
|
handled++; |
|
} |
|
} while (reread_isr); |
|
|
|
spin_unlock(&card->irq_lock); |
|
|
|
return handled ? IRQ_HANDLED : IRQ_NONE; |
|
} |
|
|
|
/*----------------- Card Event Handler -------------------*/ |
|
static const char * const rsxx_card_state_to_str(unsigned int state) |
|
{ |
|
static const char * const state_strings[] = { |
|
"Unknown", "Shutdown", "Starting", "Formatting", |
|
"Uninitialized", "Good", "Shutting Down", |
|
"Fault", "Read Only Fault", "dStroying" |
|
}; |
|
|
|
return state_strings[ffs(state)]; |
|
} |
|
|
|
static void card_state_change(struct rsxx_cardinfo *card, |
|
unsigned int new_state) |
|
{ |
|
int st; |
|
|
|
dev_info(CARD_TO_DEV(card), |
|
"card state change detected.(%s -> %s)\n", |
|
rsxx_card_state_to_str(card->state), |
|
rsxx_card_state_to_str(new_state)); |
|
|
|
card->state = new_state; |
|
|
|
/* Don't attach DMA interfaces if the card has an invalid config */ |
|
if (!card->config_valid) |
|
return; |
|
|
|
switch (new_state) { |
|
case CARD_STATE_RD_ONLY_FAULT: |
|
dev_crit(CARD_TO_DEV(card), |
|
"Hardware has entered read-only mode!\n"); |
|
/* |
|
* Fall through so the DMA devices can be attached and |
|
* the user can attempt to pull off their data. |
|
*/ |
|
fallthrough; |
|
case CARD_STATE_GOOD: |
|
st = rsxx_get_card_size8(card, &card->size8); |
|
if (st) |
|
dev_err(CARD_TO_DEV(card), |
|
"Failed attaching DMA devices\n"); |
|
|
|
if (card->config_valid) |
|
set_capacity(card->gendisk, card->size8 >> 9); |
|
break; |
|
|
|
case CARD_STATE_FAULT: |
|
dev_crit(CARD_TO_DEV(card), |
|
"Hardware Fault reported!\n"); |
|
fallthrough; |
|
|
|
/* Everything else, detach DMA interface if it's attached. */ |
|
case CARD_STATE_SHUTDOWN: |
|
case CARD_STATE_STARTING: |
|
case CARD_STATE_FORMATTING: |
|
case CARD_STATE_UNINITIALIZED: |
|
case CARD_STATE_SHUTTING_DOWN: |
|
/* |
|
* dStroy is a term coined by marketing to represent the low level |
|
* secure erase. |
|
*/ |
|
case CARD_STATE_DSTROYING: |
|
set_capacity(card->gendisk, 0); |
|
break; |
|
} |
|
} |
|
|
|
static void card_event_handler(struct work_struct *work) |
|
{ |
|
struct rsxx_cardinfo *card; |
|
unsigned int state; |
|
unsigned long flags; |
|
int st; |
|
|
|
card = container_of(work, struct rsxx_cardinfo, event_work); |
|
|
|
if (unlikely(card->halt)) |
|
return; |
|
|
|
/* |
|
* Enable the interrupt now to avoid any weird race conditions where a |
|
* state change might occur while rsxx_get_card_state() is |
|
* processing a returned creg cmd. |
|
*/ |
|
spin_lock_irqsave(&card->irq_lock, flags); |
|
rsxx_enable_ier_and_isr(card, CR_INTR_EVENT); |
|
spin_unlock_irqrestore(&card->irq_lock, flags); |
|
|
|
st = rsxx_get_card_state(card, &state); |
|
if (st) { |
|
dev_info(CARD_TO_DEV(card), |
|
"Failed reading state after event.\n"); |
|
return; |
|
} |
|
|
|
if (card->state != state) |
|
card_state_change(card, state); |
|
|
|
if (card->creg_ctrl.creg_stats.stat & CREG_STAT_LOG_PENDING) |
|
rsxx_read_hw_log(card); |
|
} |
|
|
|
/*----------------- Card Operations -------------------*/ |
|
static int card_shutdown(struct rsxx_cardinfo *card) |
|
{ |
|
unsigned int state; |
|
signed long start; |
|
const int timeout = msecs_to_jiffies(120000); |
|
int st; |
|
|
|
/* We can't issue a shutdown if the card is in a transition state */ |
|
start = jiffies; |
|
do { |
|
st = rsxx_get_card_state(card, &state); |
|
if (st) |
|
return st; |
|
} while (state == CARD_STATE_STARTING && |
|
(jiffies - start < timeout)); |
|
|
|
if (state == CARD_STATE_STARTING) |
|
return -ETIMEDOUT; |
|
|
|
/* Only issue a shutdown if we need to */ |
|
if ((state != CARD_STATE_SHUTTING_DOWN) && |
|
(state != CARD_STATE_SHUTDOWN)) { |
|
st = rsxx_issue_card_cmd(card, CARD_CMD_SHUTDOWN); |
|
if (st) |
|
return st; |
|
} |
|
|
|
start = jiffies; |
|
do { |
|
st = rsxx_get_card_state(card, &state); |
|
if (st) |
|
return st; |
|
} while (state != CARD_STATE_SHUTDOWN && |
|
(jiffies - start < timeout)); |
|
|
|
if (state != CARD_STATE_SHUTDOWN) |
|
return -ETIMEDOUT; |
|
|
|
return 0; |
|
} |
|
|
|
static int rsxx_eeh_frozen(struct pci_dev *dev) |
|
{ |
|
struct rsxx_cardinfo *card = pci_get_drvdata(dev); |
|
int i; |
|
int st; |
|
|
|
dev_warn(&dev->dev, "IBM Flash Adapter PCI: preparing for slot reset.\n"); |
|
|
|
card->eeh_state = 1; |
|
rsxx_mask_interrupts(card); |
|
|
|
/* |
|
* We need to guarantee that the write for eeh_state and masking |
|
* interrupts does not become reordered. This will prevent a possible |
|
* race condition with the EEH code. |
|
*/ |
|
wmb(); |
|
|
|
pci_disable_device(dev); |
|
|
|
st = rsxx_eeh_save_issued_dmas(card); |
|
if (st) |
|
return st; |
|
|
|
rsxx_eeh_save_issued_creg(card); |
|
|
|
for (i = 0; i < card->n_targets; i++) { |
|
if (card->ctrl[i].status.buf) |
|
dma_free_coherent(&card->dev->dev, |
|
STATUS_BUFFER_SIZE8, |
|
card->ctrl[i].status.buf, |
|
card->ctrl[i].status.dma_addr); |
|
if (card->ctrl[i].cmd.buf) |
|
dma_free_coherent(&card->dev->dev, |
|
COMMAND_BUFFER_SIZE8, |
|
card->ctrl[i].cmd.buf, |
|
card->ctrl[i].cmd.dma_addr); |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static void rsxx_eeh_failure(struct pci_dev *dev) |
|
{ |
|
struct rsxx_cardinfo *card = pci_get_drvdata(dev); |
|
int i; |
|
int cnt = 0; |
|
|
|
dev_err(&dev->dev, "IBM Flash Adapter PCI: disabling failed card.\n"); |
|
|
|
card->eeh_state = 1; |
|
card->halt = 1; |
|
|
|
for (i = 0; i < card->n_targets; i++) { |
|
spin_lock_bh(&card->ctrl[i].queue_lock); |
|
cnt = rsxx_cleanup_dma_queue(&card->ctrl[i], |
|
&card->ctrl[i].queue, |
|
COMPLETE_DMA); |
|
spin_unlock_bh(&card->ctrl[i].queue_lock); |
|
|
|
cnt += rsxx_dma_cancel(&card->ctrl[i]); |
|
|
|
if (cnt) |
|
dev_info(CARD_TO_DEV(card), |
|
"Freed %d queued DMAs on channel %d\n", |
|
cnt, card->ctrl[i].id); |
|
} |
|
} |
|
|
|
static int rsxx_eeh_fifo_flush_poll(struct rsxx_cardinfo *card) |
|
{ |
|
unsigned int status; |
|
int iter = 0; |
|
|
|
/* We need to wait for the hardware to reset */ |
|
while (iter++ < 10) { |
|
status = ioread32(card->regmap + PCI_RECONFIG); |
|
|
|
if (status & RSXX_FLUSH_BUSY) { |
|
ssleep(1); |
|
continue; |
|
} |
|
|
|
if (status & RSXX_FLUSH_TIMEOUT) |
|
dev_warn(CARD_TO_DEV(card), "HW: flash controller timeout\n"); |
|
return 0; |
|
} |
|
|
|
/* Hardware failed resetting itself. */ |
|
return -1; |
|
} |
|
|
|
static pci_ers_result_t rsxx_error_detected(struct pci_dev *dev, |
|
pci_channel_state_t error) |
|
{ |
|
int st; |
|
|
|
if (dev->revision < RSXX_EEH_SUPPORT) |
|
return PCI_ERS_RESULT_NONE; |
|
|
|
if (error == pci_channel_io_perm_failure) { |
|
rsxx_eeh_failure(dev); |
|
return PCI_ERS_RESULT_DISCONNECT; |
|
} |
|
|
|
st = rsxx_eeh_frozen(dev); |
|
if (st) { |
|
dev_err(&dev->dev, "Slot reset setup failed\n"); |
|
rsxx_eeh_failure(dev); |
|
return PCI_ERS_RESULT_DISCONNECT; |
|
} |
|
|
|
return PCI_ERS_RESULT_NEED_RESET; |
|
} |
|
|
|
static pci_ers_result_t rsxx_slot_reset(struct pci_dev *dev) |
|
{ |
|
struct rsxx_cardinfo *card = pci_get_drvdata(dev); |
|
unsigned long flags; |
|
int i; |
|
int st; |
|
|
|
dev_warn(&dev->dev, |
|
"IBM Flash Adapter PCI: recovering from slot reset.\n"); |
|
|
|
st = pci_enable_device(dev); |
|
if (st) |
|
goto failed_hw_setup; |
|
|
|
pci_set_master(dev); |
|
|
|
st = rsxx_eeh_fifo_flush_poll(card); |
|
if (st) |
|
goto failed_hw_setup; |
|
|
|
rsxx_dma_queue_reset(card); |
|
|
|
for (i = 0; i < card->n_targets; i++) { |
|
st = rsxx_hw_buffers_init(dev, &card->ctrl[i]); |
|
if (st) |
|
goto failed_hw_buffers_init; |
|
} |
|
|
|
if (card->config_valid) |
|
rsxx_dma_configure(card); |
|
|
|
/* Clears the ISR register from spurious interrupts */ |
|
st = ioread32(card->regmap + ISR); |
|
|
|
card->eeh_state = 0; |
|
|
|
spin_lock_irqsave(&card->irq_lock, flags); |
|
if (card->n_targets & RSXX_MAX_TARGETS) |
|
rsxx_enable_ier_and_isr(card, CR_INTR_ALL_G); |
|
else |
|
rsxx_enable_ier_and_isr(card, CR_INTR_ALL_C); |
|
spin_unlock_irqrestore(&card->irq_lock, flags); |
|
|
|
rsxx_kick_creg_queue(card); |
|
|
|
for (i = 0; i < card->n_targets; i++) { |
|
spin_lock(&card->ctrl[i].queue_lock); |
|
if (list_empty(&card->ctrl[i].queue)) { |
|
spin_unlock(&card->ctrl[i].queue_lock); |
|
continue; |
|
} |
|
spin_unlock(&card->ctrl[i].queue_lock); |
|
|
|
queue_work(card->ctrl[i].issue_wq, |
|
&card->ctrl[i].issue_dma_work); |
|
} |
|
|
|
dev_info(&dev->dev, "IBM Flash Adapter PCI: recovery complete.\n"); |
|
|
|
return PCI_ERS_RESULT_RECOVERED; |
|
|
|
failed_hw_buffers_init: |
|
for (i = 0; i < card->n_targets; i++) { |
|
if (card->ctrl[i].status.buf) |
|
dma_free_coherent(&card->dev->dev, |
|
STATUS_BUFFER_SIZE8, |
|
card->ctrl[i].status.buf, |
|
card->ctrl[i].status.dma_addr); |
|
if (card->ctrl[i].cmd.buf) |
|
dma_free_coherent(&card->dev->dev, |
|
COMMAND_BUFFER_SIZE8, |
|
card->ctrl[i].cmd.buf, |
|
card->ctrl[i].cmd.dma_addr); |
|
} |
|
failed_hw_setup: |
|
rsxx_eeh_failure(dev); |
|
return PCI_ERS_RESULT_DISCONNECT; |
|
|
|
} |
|
|
|
/*----------------- Driver Initialization & Setup -------------------*/ |
|
/* Returns: 0 if the driver is compatible with the device |
|
-1 if the driver is NOT compatible with the device */ |
|
static int rsxx_compatibility_check(struct rsxx_cardinfo *card) |
|
{ |
|
unsigned char pci_rev; |
|
|
|
pci_read_config_byte(card->dev, PCI_REVISION_ID, &pci_rev); |
|
|
|
if (pci_rev > RS70_PCI_REV_SUPPORTED) |
|
return -1; |
|
return 0; |
|
} |
|
|
|
static int rsxx_pci_probe(struct pci_dev *dev, |
|
const struct pci_device_id *id) |
|
{ |
|
struct rsxx_cardinfo *card; |
|
int st; |
|
unsigned int sync_timeout; |
|
|
|
dev_info(&dev->dev, "PCI-Flash SSD discovered\n"); |
|
|
|
card = kzalloc(sizeof(*card), GFP_KERNEL); |
|
if (!card) |
|
return -ENOMEM; |
|
|
|
card->dev = dev; |
|
pci_set_drvdata(dev, card); |
|
|
|
st = ida_alloc(&rsxx_disk_ida, GFP_KERNEL); |
|
if (st < 0) |
|
goto failed_ida_get; |
|
card->disk_id = st; |
|
|
|
st = pci_enable_device(dev); |
|
if (st) |
|
goto failed_enable; |
|
|
|
pci_set_master(dev); |
|
|
|
st = dma_set_mask(&dev->dev, DMA_BIT_MASK(64)); |
|
if (st) { |
|
dev_err(CARD_TO_DEV(card), |
|
"No usable DMA configuration,aborting\n"); |
|
goto failed_dma_mask; |
|
} |
|
|
|
st = pci_request_regions(dev, DRIVER_NAME); |
|
if (st) { |
|
dev_err(CARD_TO_DEV(card), |
|
"Failed to request memory region\n"); |
|
goto failed_request_regions; |
|
} |
|
|
|
if (pci_resource_len(dev, 0) == 0) { |
|
dev_err(CARD_TO_DEV(card), "BAR0 has length 0!\n"); |
|
st = -ENOMEM; |
|
goto failed_iomap; |
|
} |
|
|
|
card->regmap = pci_iomap(dev, 0, 0); |
|
if (!card->regmap) { |
|
dev_err(CARD_TO_DEV(card), "Failed to map BAR0\n"); |
|
st = -ENOMEM; |
|
goto failed_iomap; |
|
} |
|
|
|
spin_lock_init(&card->irq_lock); |
|
card->halt = 0; |
|
card->eeh_state = 0; |
|
|
|
spin_lock_irq(&card->irq_lock); |
|
rsxx_disable_ier_and_isr(card, CR_INTR_ALL); |
|
spin_unlock_irq(&card->irq_lock); |
|
|
|
if (!force_legacy) { |
|
st = pci_enable_msi(dev); |
|
if (st) |
|
dev_warn(CARD_TO_DEV(card), |
|
"Failed to enable MSI\n"); |
|
} |
|
|
|
st = request_irq(dev->irq, rsxx_isr, IRQF_SHARED, |
|
DRIVER_NAME, card); |
|
if (st) { |
|
dev_err(CARD_TO_DEV(card), |
|
"Failed requesting IRQ%d\n", dev->irq); |
|
goto failed_irq; |
|
} |
|
|
|
/************* Setup Processor Command Interface *************/ |
|
st = rsxx_creg_setup(card); |
|
if (st) { |
|
dev_err(CARD_TO_DEV(card), "Failed to setup creg interface.\n"); |
|
goto failed_creg_setup; |
|
} |
|
|
|
spin_lock_irq(&card->irq_lock); |
|
rsxx_enable_ier_and_isr(card, CR_INTR_CREG); |
|
spin_unlock_irq(&card->irq_lock); |
|
|
|
st = rsxx_compatibility_check(card); |
|
if (st) { |
|
dev_warn(CARD_TO_DEV(card), |
|
"Incompatible driver detected. Please update the driver.\n"); |
|
st = -EINVAL; |
|
goto failed_compatiblity_check; |
|
} |
|
|
|
/************* Load Card Config *************/ |
|
st = rsxx_load_config(card); |
|
if (st) |
|
dev_err(CARD_TO_DEV(card), |
|
"Failed loading card config\n"); |
|
|
|
/************* Setup DMA Engine *************/ |
|
st = rsxx_get_num_targets(card, &card->n_targets); |
|
if (st) |
|
dev_info(CARD_TO_DEV(card), |
|
"Failed reading the number of DMA targets\n"); |
|
|
|
card->ctrl = kcalloc(card->n_targets, sizeof(*card->ctrl), |
|
GFP_KERNEL); |
|
if (!card->ctrl) { |
|
st = -ENOMEM; |
|
goto failed_dma_setup; |
|
} |
|
|
|
st = rsxx_dma_setup(card); |
|
if (st) { |
|
dev_info(CARD_TO_DEV(card), |
|
"Failed to setup DMA engine\n"); |
|
goto failed_dma_setup; |
|
} |
|
|
|
/************* Setup Card Event Handler *************/ |
|
card->event_wq = create_singlethread_workqueue(DRIVER_NAME"_event"); |
|
if (!card->event_wq) { |
|
dev_err(CARD_TO_DEV(card), "Failed card event setup.\n"); |
|
st = -ENOMEM; |
|
goto failed_event_handler; |
|
} |
|
|
|
INIT_WORK(&card->event_work, card_event_handler); |
|
|
|
st = rsxx_setup_dev(card); |
|
if (st) |
|
goto failed_create_dev; |
|
|
|
rsxx_get_card_state(card, &card->state); |
|
|
|
dev_info(CARD_TO_DEV(card), |
|
"card state: %s\n", |
|
rsxx_card_state_to_str(card->state)); |
|
|
|
/* |
|
* Now that the DMA Engine and devices have been setup, |
|
* we can enable the event interrupt(it kicks off actions in |
|
* those layers so we couldn't enable it right away.) |
|
*/ |
|
spin_lock_irq(&card->irq_lock); |
|
rsxx_enable_ier_and_isr(card, CR_INTR_EVENT); |
|
spin_unlock_irq(&card->irq_lock); |
|
|
|
if (card->state == CARD_STATE_SHUTDOWN) { |
|
st = rsxx_issue_card_cmd(card, CARD_CMD_STARTUP); |
|
if (st) |
|
dev_crit(CARD_TO_DEV(card), |
|
"Failed issuing card startup\n"); |
|
if (sync_start) { |
|
sync_timeout = SYNC_START_TIMEOUT; |
|
|
|
dev_info(CARD_TO_DEV(card), |
|
"Waiting for card to startup\n"); |
|
|
|
do { |
|
ssleep(1); |
|
sync_timeout--; |
|
|
|
rsxx_get_card_state(card, &card->state); |
|
} while (sync_timeout && |
|
(card->state == CARD_STATE_STARTING)); |
|
|
|
if (card->state == CARD_STATE_STARTING) { |
|
dev_warn(CARD_TO_DEV(card), |
|
"Card startup timed out\n"); |
|
card->size8 = 0; |
|
} else { |
|
dev_info(CARD_TO_DEV(card), |
|
"card state: %s\n", |
|
rsxx_card_state_to_str(card->state)); |
|
st = rsxx_get_card_size8(card, &card->size8); |
|
if (st) |
|
card->size8 = 0; |
|
} |
|
} |
|
} else if (card->state == CARD_STATE_GOOD || |
|
card->state == CARD_STATE_RD_ONLY_FAULT) { |
|
st = rsxx_get_card_size8(card, &card->size8); |
|
if (st) |
|
card->size8 = 0; |
|
} |
|
|
|
rsxx_attach_dev(card); |
|
|
|
/************* Setup Debugfs *************/ |
|
rsxx_debugfs_dev_new(card); |
|
|
|
return 0; |
|
|
|
failed_create_dev: |
|
destroy_workqueue(card->event_wq); |
|
card->event_wq = NULL; |
|
failed_event_handler: |
|
rsxx_dma_destroy(card); |
|
failed_dma_setup: |
|
failed_compatiblity_check: |
|
destroy_workqueue(card->creg_ctrl.creg_wq); |
|
card->creg_ctrl.creg_wq = NULL; |
|
failed_creg_setup: |
|
spin_lock_irq(&card->irq_lock); |
|
rsxx_disable_ier_and_isr(card, CR_INTR_ALL); |
|
spin_unlock_irq(&card->irq_lock); |
|
free_irq(dev->irq, card); |
|
if (!force_legacy) |
|
pci_disable_msi(dev); |
|
failed_irq: |
|
pci_iounmap(dev, card->regmap); |
|
failed_iomap: |
|
pci_release_regions(dev); |
|
failed_request_regions: |
|
failed_dma_mask: |
|
pci_disable_device(dev); |
|
failed_enable: |
|
ida_free(&rsxx_disk_ida, card->disk_id); |
|
failed_ida_get: |
|
kfree(card); |
|
|
|
return st; |
|
} |
|
|
|
static void rsxx_pci_remove(struct pci_dev *dev) |
|
{ |
|
struct rsxx_cardinfo *card = pci_get_drvdata(dev); |
|
unsigned long flags; |
|
int st; |
|
int i; |
|
|
|
if (!card) |
|
return; |
|
|
|
dev_info(CARD_TO_DEV(card), |
|
"Removing PCI-Flash SSD.\n"); |
|
|
|
rsxx_detach_dev(card); |
|
|
|
for (i = 0; i < card->n_targets; i++) { |
|
spin_lock_irqsave(&card->irq_lock, flags); |
|
rsxx_disable_ier_and_isr(card, CR_INTR_DMA(i)); |
|
spin_unlock_irqrestore(&card->irq_lock, flags); |
|
} |
|
|
|
st = card_shutdown(card); |
|
if (st) |
|
dev_crit(CARD_TO_DEV(card), "Shutdown failed!\n"); |
|
|
|
/* Sync outstanding event handlers. */ |
|
spin_lock_irqsave(&card->irq_lock, flags); |
|
rsxx_disable_ier_and_isr(card, CR_INTR_EVENT); |
|
spin_unlock_irqrestore(&card->irq_lock, flags); |
|
|
|
cancel_work_sync(&card->event_work); |
|
|
|
destroy_workqueue(card->event_wq); |
|
rsxx_destroy_dev(card); |
|
rsxx_dma_destroy(card); |
|
destroy_workqueue(card->creg_ctrl.creg_wq); |
|
|
|
spin_lock_irqsave(&card->irq_lock, flags); |
|
rsxx_disable_ier_and_isr(card, CR_INTR_ALL); |
|
spin_unlock_irqrestore(&card->irq_lock, flags); |
|
|
|
/* Prevent work_structs from re-queuing themselves. */ |
|
card->halt = 1; |
|
|
|
debugfs_remove_recursive(card->debugfs_dir); |
|
|
|
free_irq(dev->irq, card); |
|
|
|
if (!force_legacy) |
|
pci_disable_msi(dev); |
|
|
|
rsxx_creg_destroy(card); |
|
|
|
pci_iounmap(dev, card->regmap); |
|
|
|
pci_disable_device(dev); |
|
pci_release_regions(dev); |
|
|
|
ida_free(&rsxx_disk_ida, card->disk_id); |
|
kfree(card); |
|
} |
|
|
|
static int rsxx_pci_suspend(struct pci_dev *dev, pm_message_t state) |
|
{ |
|
/* We don't support suspend at this time. */ |
|
return -ENOSYS; |
|
} |
|
|
|
static void rsxx_pci_shutdown(struct pci_dev *dev) |
|
{ |
|
struct rsxx_cardinfo *card = pci_get_drvdata(dev); |
|
unsigned long flags; |
|
int i; |
|
|
|
if (!card) |
|
return; |
|
|
|
dev_info(CARD_TO_DEV(card), "Shutting down PCI-Flash SSD.\n"); |
|
|
|
rsxx_detach_dev(card); |
|
|
|
for (i = 0; i < card->n_targets; i++) { |
|
spin_lock_irqsave(&card->irq_lock, flags); |
|
rsxx_disable_ier_and_isr(card, CR_INTR_DMA(i)); |
|
spin_unlock_irqrestore(&card->irq_lock, flags); |
|
} |
|
|
|
card_shutdown(card); |
|
} |
|
|
|
static const struct pci_error_handlers rsxx_err_handler = { |
|
.error_detected = rsxx_error_detected, |
|
.slot_reset = rsxx_slot_reset, |
|
}; |
|
|
|
static const struct pci_device_id rsxx_pci_ids[] = { |
|
{PCI_DEVICE(PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_FS70_FLASH)}, |
|
{PCI_DEVICE(PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_FS80_FLASH)}, |
|
{0,}, |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(pci, rsxx_pci_ids); |
|
|
|
static struct pci_driver rsxx_pci_driver = { |
|
.name = DRIVER_NAME, |
|
.id_table = rsxx_pci_ids, |
|
.probe = rsxx_pci_probe, |
|
.remove = rsxx_pci_remove, |
|
.suspend = rsxx_pci_suspend, |
|
.shutdown = rsxx_pci_shutdown, |
|
.err_handler = &rsxx_err_handler, |
|
}; |
|
|
|
static int __init rsxx_core_init(void) |
|
{ |
|
int st; |
|
|
|
st = rsxx_dev_init(); |
|
if (st) |
|
return st; |
|
|
|
st = rsxx_dma_init(); |
|
if (st) |
|
goto dma_init_failed; |
|
|
|
st = rsxx_creg_init(); |
|
if (st) |
|
goto creg_init_failed; |
|
|
|
return pci_register_driver(&rsxx_pci_driver); |
|
|
|
creg_init_failed: |
|
rsxx_dma_cleanup(); |
|
dma_init_failed: |
|
rsxx_dev_cleanup(); |
|
|
|
return st; |
|
} |
|
|
|
static void __exit rsxx_core_cleanup(void) |
|
{ |
|
pci_unregister_driver(&rsxx_pci_driver); |
|
rsxx_creg_cleanup(); |
|
rsxx_dma_cleanup(); |
|
rsxx_dev_cleanup(); |
|
} |
|
|
|
module_init(rsxx_core_init); |
|
module_exit(rsxx_core_cleanup);
|
|
|