Before, the partition table would have to be reread because our card was attached before it transistioned out of it's 'starting' state. This change will cause the driver to wait to attach the device until the adapter is ready. Signed-off-by: Philip J Kelleher <pjk1939@linux.vnet.ibm.com> Signed-off-by: Jens Axboe <axboe@kernel.dk>
923 lines
21 KiB
C
923 lines
21 KiB
C
/*
|
|
* Filename: core.c
|
|
*
|
|
*
|
|
* Authors: Joshua Morris <josh.h.morris@us.ibm.com>
|
|
* Philip Kelleher <pjk1939@linux.vnet.ibm.com>
|
|
*
|
|
* (C) Copyright 2013 IBM Corporation
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of the
|
|
* License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software Foundation,
|
|
* Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*/
|
|
|
|
#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/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 FlashSystem 70/80 PCIe SSD 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);
|
|
static DEFINE_SPINLOCK(rsxx_ida_lock);
|
|
|
|
/*----------------- 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.
|
|
*/
|
|
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");
|
|
/* Fall through. */
|
|
|
|
/* 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 FlashSystem 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)
|
|
pci_free_consistent(card->dev, STATUS_BUFFER_SIZE8,
|
|
card->ctrl[i].status.buf,
|
|
card->ctrl[i].status.dma_addr);
|
|
if (card->ctrl[i].cmd.buf)
|
|
pci_free_consistent(card->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 FlashSystem 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);
|
|
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,
|
|
enum pci_channel_state 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 FlashSystem 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;
|
|
|
|
st = rsxx_eeh_remap_dmas(card);
|
|
if (st)
|
|
goto failed_remap_dmas;
|
|
|
|
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 FlashSystem PCI: recovery complete.\n");
|
|
|
|
return PCI_ERS_RESULT_RECOVERED;
|
|
|
|
failed_hw_buffers_init:
|
|
failed_remap_dmas:
|
|
for (i = 0; i < card->n_targets; i++) {
|
|
if (card->ctrl[i].status.buf)
|
|
pci_free_consistent(card->dev,
|
|
STATUS_BUFFER_SIZE8,
|
|
card->ctrl[i].status.buf,
|
|
card->ctrl[i].status.dma_addr);
|
|
if (card->ctrl[i].cmd.buf)
|
|
pci_free_consistent(card->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);
|
|
|
|
do {
|
|
if (!ida_pre_get(&rsxx_disk_ida, GFP_KERNEL)) {
|
|
st = -ENOMEM;
|
|
goto failed_ida_get;
|
|
}
|
|
|
|
spin_lock(&rsxx_ida_lock);
|
|
st = ida_get_new(&rsxx_disk_ida, &card->disk_id);
|
|
spin_unlock(&rsxx_ida_lock);
|
|
} while (st == -EAGAIN);
|
|
|
|
if (st)
|
|
goto failed_ida_get;
|
|
|
|
st = pci_enable_device(dev);
|
|
if (st)
|
|
goto failed_enable;
|
|
|
|
pci_set_master(dev);
|
|
pci_set_dma_max_seg_size(dev, RSXX_HW_BLK_SIZE);
|
|
|
|
st = pci_set_dma_mask(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_DISABLED | 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 = kzalloc(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");
|
|
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);
|
|
|
|
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:
|
|
spin_lock(&rsxx_ida_lock);
|
|
ida_remove(&rsxx_disk_ida, card->disk_id);
|
|
spin_unlock(&rsxx_ida_lock);
|
|
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);
|
|
|
|
rsxx_destroy_dev(card);
|
|
rsxx_dma_destroy(card);
|
|
|
|
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;
|
|
|
|
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);
|
|
|
|
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 DEFINE_PCI_DEVICE_TABLE(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);
|