#include <sys/param.h>
#include <sys/types.h>
#include <sys/bus.h>
#include <sys/cdefs.h>
#include <sys/condvar.h>
#include <sys/device.h>
#include <sys/errno.h>
#include <sys/mutex.h>
#include <sys/systm.h>
#include <dev/fdt/fdtvar.h>
#include <dev/sdmmc/sdmmcchip.h>
#include <dev/sdmmc/sdmmcreg.h>
#include <dev/sdmmc/sdmmcvar.h>
#include <arm/imx/imx23_icollreg.h>
#include <arm/imx/imx23_mmcreg.h>
#include <arm/imx/imx23var.h>
#include <arm/pic/picvar.h>
struct imx23_mmc_softc {
device_t sc_dev;
struct fdtbus_dma *dma_channel;
bus_space_handle_t sc_hdl;
bus_space_tag_t sc_iot;
device_t sc_sdmmc;
kmutex_t sc_lock;
struct kcondvar sc_intr_cv;
uint32_t sc_irq_error;
uint8_t sc_state;
uint8_t sc_bus_width;
uint32_t pio_words[3];
};
static int imx23_mmc_match(device_t, cfdata_t, void *);
static void imx23_mmc_attach(device_t, device_t, void *);
static void imx23_mmc_reset(struct imx23_mmc_softc *);
static void imx23_mmc_init(struct imx23_mmc_softc *);
static uint32_t imx23_mmc_set_sck(struct imx23_mmc_softc *, uint32_t);
static void imx23_mmc_dma_intr(void *);
static int imx23_mmc_error_intr(void *);
static void imx23_mmc_prepare_data_command(struct imx23_mmc_softc *,
struct fdtbus_dma_req *, struct sdmmc_command *);
static void imx23_mmc_prepare_command(struct imx23_mmc_softc *,
struct fdtbus_dma_req *, struct sdmmc_command *);
static int imx23_mmc_host_reset(sdmmc_chipset_handle_t);
static uint32_t imx23_mmc_host_ocr(sdmmc_chipset_handle_t);
static int imx23_mmc_host_maxblklen(sdmmc_chipset_handle_t);
static int imx23_mmc_card_detect(sdmmc_chipset_handle_t);
static int imx23_mmc_write_protect(sdmmc_chipset_handle_t);
static int imx23_mmc_bus_power(sdmmc_chipset_handle_t, uint32_t);
static int imx23_mmc_bus_clock(sdmmc_chipset_handle_t, int);
static int imx23_mmc_bus_width(sdmmc_chipset_handle_t, int);
static int imx23_mmc_bus_rod(sdmmc_chipset_handle_t, int);
static void imx23_mmc_exec_command(sdmmc_chipset_handle_t,
struct sdmmc_command *);
static void imx23_mmc_card_enable_intr(sdmmc_chipset_handle_t, int);
static void imx23_mmc_card_intr_ack(sdmmc_chipset_handle_t);
static struct sdmmc_chip_functions imx23_mmc_functions = {
.host_reset = imx23_mmc_host_reset,
.host_ocr = imx23_mmc_host_ocr,
.host_maxblklen = imx23_mmc_host_maxblklen,
.card_detect = imx23_mmc_card_detect,
.write_protect = imx23_mmc_write_protect,
.bus_power = imx23_mmc_bus_power,
.bus_clock = imx23_mmc_bus_clock,
.bus_width = imx23_mmc_bus_width,
.bus_rod = imx23_mmc_bus_rod,
.exec_command = imx23_mmc_exec_command,
.card_enable_intr = imx23_mmc_card_enable_intr,
.card_intr_ack = imx23_mmc_card_intr_ack
};
CFATTACH_DECL_NEW(imx23mmc, sizeof(struct imx23_mmc_softc), imx23_mmc_match,
imx23_mmc_attach, NULL, NULL);
#define SSP_SOFT_RST_LOOP 455
#define SSP_RD(sc, reg) \
bus_space_read_4(sc->sc_iot, sc->sc_hdl, (reg))
#define SSP_WR(sc, reg, val) \
bus_space_write_4(sc->sc_iot, sc->sc_hdl, (reg), (val))
#define SSP_CLK 160000000
#define SSP_CLK_MIN 400
#define SSP_CLK_MAX 48000
#define DATA_TIMEOUT 0x4240
#define BUS_WIDTH_1_BIT 0x0
#define BUS_WIDTH_4_BIT 0x1
#define BUS_WIDTH_8_BIT 0x2
#define SSP_STATE_IDLE 0
#define SSP_STATE_DMA 1
#define HW_SSP_CTRL1_IRQ_MASK ( \
HW_SSP_CTRL1_SDIO_IRQ | \
HW_SSP_CTRL1_RESP_ERR_IRQ | \
HW_SSP_CTRL1_RESP_TIMEOUT_IRQ | \
HW_SSP_CTRL1_DATA_TIMEOUT_IRQ | \
HW_SSP_CTRL1_DATA_CRC_IRQ | \
HW_SSP_CTRL1_FIFO_UNDERRUN_IRQ | \
HW_SSP_CTRL1_RECV_TIMEOUT_IRQ | \
HW_SSP_CTRL1_FIFO_OVERRUN_IRQ)
#define MAX_TRANSFER_SIZE 65536
#define PIO_WORD_CTRL0 0
#define PIO_WORD_CMD0 1
#define PIO_WORD_CMD1 2
static const struct device_compatible_entry compat_data[] = {
{ .compat = "fsl,imx23-mmc" },
DEVICE_COMPAT_EOL
};
static int
imx23_mmc_match(device_t parent, cfdata_t match, void *aux)
{
struct fdt_attach_args *const faa = aux;
return of_compatible_match(faa->faa_phandle, compat_data);
}
static void
imx23_mmc_attach(device_t parent, device_t self, void *aux)
{
struct imx23_mmc_softc *const sc = device_private(self);
struct fdt_attach_args *const faa = aux;
const int phandle = faa->faa_phandle;
struct sdmmcbus_attach_args saa;
char intrstr[128];
sc->sc_dev = self;
sc->sc_iot = faa->faa_bst;
bus_addr_t addr;
bus_size_t size;
if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
aprint_error(": couldn't get register address\n");
return;
}
if (bus_space_map(faa->faa_bst, addr, size, 0, &sc->sc_hdl)) {
aprint_error(": couldn't map registers\n");
return;
}
mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SCHED);
cv_init(&sc->sc_intr_cv, "ssp_intr");
sc->dma_channel = fdtbus_dma_get(phandle,"rx-tx", imx23_mmc_dma_intr,
sc);
if(sc->dma_channel == NULL) {
aprint_error(": couldn't map registers\n");
return;
}
if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
aprint_error(": failed to decode interrupt\n");
return;
}
void *ih = fdtbus_intr_establish_xname(phandle, 0, IPL_SDMMC, IST_LEVEL,
imx23_mmc_error_intr, sc,
device_xname(self));
if (ih == NULL) {
aprint_error_dev(self, "couldn't establish error interrupt\n");
return;
}
imx23_mmc_reset(sc);
imx23_mmc_init(sc);
uint32_t imx23_mmc_vers = SSP_RD(sc, HW_SSP_VERSION);
aprint_normal(": SSP Block v%" __PRIuBIT ".%" __PRIuBIT "\n",
__SHIFTOUT(imx23_mmc_vers, HW_SSP_VERSION_MAJOR),
__SHIFTOUT(imx23_mmc_vers, HW_SSP_VERSION_MINOR));
memset(&saa, 0, sizeof(saa));
saa.saa_busname = "sdmmc";
saa.saa_sct = &imx23_mmc_functions;
saa.saa_spi_sct = NULL;
saa.saa_sch = sc;
saa.saa_dmat = faa->faa_dmat;
saa.saa_clkmin = SSP_CLK_MIN;
saa.saa_clkmax = SSP_CLK_MAX;
saa.saa_caps = SMC_CAPS_DMA | SMC_CAPS_4BIT_MODE |
SMC_CAPS_MULTI_SEG_DMA;
sc->sc_sdmmc = config_found(sc->sc_dev, &saa, NULL, CFARGS_NONE);
if (sc->sc_sdmmc == NULL) {
aprint_error_dev(sc->sc_dev, "unable to attach sdmmc\n");
return;
}
}
static int
imx23_mmc_host_reset(sdmmc_chipset_handle_t sch)
{
struct imx23_mmc_softc *sc = sch;
imx23_mmc_reset(sc);
return 0;
}
static uint32_t
imx23_mmc_host_ocr(sdmmc_chipset_handle_t sch)
{
return MMC_OCR_3_2V_3_3V;
}
static int
imx23_mmc_host_maxblklen(sdmmc_chipset_handle_t sch)
{
return 512;
}
static int
imx23_mmc_card_detect(sdmmc_chipset_handle_t sch)
{
return 1;
}
static int
imx23_mmc_write_protect(sdmmc_chipset_handle_t sch)
{
return 0;
}
static int
imx23_mmc_bus_power(sdmmc_chipset_handle_t sch, uint32_t ocr)
{
return 0;
}
static int
imx23_mmc_bus_clock(sdmmc_chipset_handle_t sch, int clock)
{
struct imx23_mmc_softc *sc = sch;
uint32_t sck;
if (clock < SSP_CLK_MIN)
sck = imx23_mmc_set_sck(sc, SSP_CLK_MIN * 1000);
else
sck = imx23_mmc_set_sck(sc, clock * 1000);
if (sck != clock * 1000) {
sck = sck / 1000;
if (((sck) / 1000) != 0)
aprint_normal_dev(sc->sc_dev, "bus clock @ %u.%03u "
"MHz\n", sck / 1000, sck % 1000);
else
aprint_normal_dev(sc->sc_dev, "bus clock @ %u KHz\n",
sck % 1000);
}
return 0;
}
static int
imx23_mmc_bus_width(sdmmc_chipset_handle_t sch, int width)
{
struct imx23_mmc_softc *sc = sch;
switch(width) {
case(1):
sc->sc_bus_width = BUS_WIDTH_1_BIT;
break;
case(4):
sc->sc_bus_width = BUS_WIDTH_4_BIT;
break;
case(8):
sc->sc_bus_width = BUS_WIDTH_8_BIT;
break;
default:
return 1;
}
return 0;
}
static int
imx23_mmc_bus_rod(sdmmc_chipset_handle_t sch, int rod)
{
return 0;
}
static void
imx23_mmc_exec_command(sdmmc_chipset_handle_t sch, struct sdmmc_command *cmd)
{
struct imx23_mmc_softc *sc = sch;
struct fdtbus_dma_req req;
if (cmd->c_data != NULL && cmd->c_datalen > MAX_TRANSFER_SIZE) {
aprint_error_dev(sc->sc_dev, "transfer size over %d: %d\n",
MAX_TRANSFER_SIZE, cmd->c_datalen);
cmd->c_error = ENODEV;
return;
}
mutex_enter(&sc->sc_lock);
if (cmd->c_data != NULL && cmd->c_datalen) {
imx23_mmc_prepare_data_command(sc, &req, cmd);
} else {
imx23_mmc_prepare_command(sc, &req, cmd);
}
sc->sc_state = SSP_STATE_DMA;
sc->sc_irq_error = 0;
cmd->c_error = 0;
if(fdtbus_dma_transfer(sc->dma_channel, &req)) {
aprint_error_dev(sc->sc_dev, "dma transfer error\n");
goto out;
}
while (sc->sc_state == SSP_STATE_DMA)
cv_wait(&sc->sc_intr_cv, &sc->sc_lock);
if (sc->sc_irq_error) {
if (sc->sc_bus_width) {
aprint_error_dev(sc->sc_dev, "SSP_ERROR_IRQ: %d\n",
sc->sc_irq_error);
}
else if(!(sc->sc_irq_error & HW_SSP_CTRL1_RESP_TIMEOUT_IRQ)) {
aprint_error_dev(sc->sc_dev, "SSP_ERROR_IRQ: %d\n",
sc->sc_irq_error);
}
cmd->c_error = sc->sc_irq_error >> 8;
}
if (ISSET(cmd->c_flags, SCF_RSP_PRESENT)) {
cmd->c_resp[0] = SSP_RD(sc, HW_SSP_SDRESP0);
if (ISSET(cmd->c_flags, SCF_RSP_136)) {
cmd->c_resp[1] = SSP_RD(sc, HW_SSP_SDRESP1);
cmd->c_resp[2] = SSP_RD(sc, HW_SSP_SDRESP2);
cmd->c_resp[3] = SSP_RD(sc, HW_SSP_SDRESP3);
cmd->c_resp[0] >>= 8;
cmd->c_resp[0] |= (0x000000FF & cmd->c_resp[1]) << 24;
cmd->c_resp[1] >>= 8;
cmd->c_resp[1] |= (0x000000FF & cmd->c_resp[2]) << 24;
cmd->c_resp[2] >>= 8;
cmd->c_resp[2] |= (0x000000FF & cmd->c_resp[3]) << 24;
cmd->c_resp[3] >>= 8;
}
}
out:
mutex_exit(&sc->sc_lock);
}
static void
imx23_mmc_card_enable_intr(sdmmc_chipset_handle_t sch, int irq)
{
struct imx23_mmc_softc *sc = sch;
aprint_error_dev(sc->sc_dev, "issp_card_enable_intr not implemented\n");
}
static void
imx23_mmc_card_intr_ack(sdmmc_chipset_handle_t sch)
{
struct imx23_mmc_softc *sc = sch;
aprint_error_dev(sc->sc_dev, "issp_card_intr_ack not implemented\n");
}
static void
imx23_mmc_reset(struct imx23_mmc_softc *sc)
{
unsigned int loop;
SSP_WR(sc, HW_SSP_CTRL0_CLR, HW_SSP_CTRL0_SFTRST);
loop = 0;
while ((SSP_RD(sc, HW_SSP_CTRL0) & HW_SSP_CTRL0_SFTRST) ||
(loop < SSP_SOFT_RST_LOOP))
loop++;
SSP_WR(sc, HW_SSP_CTRL0_CLR, HW_SSP_CTRL0_CLKGATE);
SSP_WR(sc, HW_SSP_CTRL0_SET, HW_SSP_CTRL0_SFTRST);
while (!(SSP_RD(sc, HW_SSP_CTRL0) & HW_SSP_CTRL0_CLKGATE))
continue;
SSP_WR(sc, HW_SSP_CTRL0_CLR, HW_SSP_CTRL0_SFTRST);
loop = 0;
while ((SSP_RD(sc, HW_SSP_CTRL0) & HW_SSP_CTRL0_SFTRST) ||
(loop < SSP_SOFT_RST_LOOP))
loop++;
SSP_WR(sc, HW_SSP_CTRL0_CLR, HW_SSP_CTRL0_CLKGATE);
while (SSP_RD(sc, HW_SSP_CTRL0) & HW_SSP_CTRL0_CLKGATE)
continue;
}
static void
imx23_mmc_init(struct imx23_mmc_softc *sc)
{
uint32_t reg;
reg = SSP_RD(sc, HW_SSP_CTRL0);
reg |= HW_SSP_CTRL0_ENABLE;
reg &= ~(HW_SSP_CTRL0_BUS_WIDTH);
reg |= __SHIFTIN(BUS_WIDTH_1_BIT, HW_SSP_CTRL0_BUS_WIDTH) |
HW_SSP_CTRL0_WAIT_FOR_IRQ | HW_SSP_CTRL0_ENABLE;
SSP_WR(sc, HW_SSP_CTRL0, reg);
sc->sc_bus_width = BUS_WIDTH_1_BIT;
reg = SSP_RD(sc, HW_SSP_TIMING);
reg &= ~(HW_SSP_TIMING_TIMEOUT);
reg |= __SHIFTIN(DATA_TIMEOUT, HW_SSP_TIMING_TIMEOUT);
SSP_WR(sc, HW_SSP_TIMING, reg);
imx23_mmc_set_sck(sc, SSP_CLK_MIN * 1000);
reg = SSP_RD(sc, HW_SSP_CTRL1);
reg |= HW_SSP_CTRL1_RESP_ERR_IRQ_EN |
HW_SSP_CTRL1_RESP_TIMEOUT_IRQ_EN |
HW_SSP_CTRL1_DATA_TIMEOUT_IRQ_EN |
HW_SSP_CTRL1_DATA_CRC_IRQ_EN |
HW_SSP_CTRL1_FIFO_UNDERRUN_EN |
HW_SSP_CTRL1_RECV_TIMEOUT_IRQ_EN |
HW_SSP_CTRL1_FIFO_OVERRUN_IRQ_EN;
reg |= HW_SSP_CTRL1_DMA_ENABLE;
reg |= HW_SSP_CTRL1_POLARITY;
reg &= ~(HW_SSP_CTRL1_WORD_LENGTH | HW_SSP_CTRL1_SSP_MODE);
reg |= __SHIFTIN(0x7, HW_SSP_CTRL1_WORD_LENGTH) |
__SHIFTIN(0x3, HW_SSP_CTRL1_SSP_MODE);
SSP_WR(sc, HW_SSP_CTRL1, reg);
}
static uint32_t
imx23_mmc_set_sck(struct imx23_mmc_softc *sc, uint32_t target)
{
uint32_t newclk, found, reg;
uint8_t div, rate, d, r;
found = div = rate = 0;
for (d = 2; d < 254; d++) {
for (r = 0; r < 255; r++) {
newclk = SSP_CLK / (d * (1 + r));
if (newclk == target) {
found = newclk;
div = d;
rate = r;
goto out;
}
if (newclk < target && newclk > found) {
found = newclk;
div = d;
rate = r;
}
}
}
out:
reg = SSP_RD(sc, HW_SSP_TIMING);
reg &= ~(HW_SSP_TIMING_CLOCK_DIVIDE | HW_SSP_TIMING_CLOCK_RATE);
reg |= __SHIFTIN(div, HW_SSP_TIMING_CLOCK_DIVIDE) |
__SHIFTIN(rate, HW_SSP_TIMING_CLOCK_RATE);
SSP_WR(sc, HW_SSP_TIMING, reg);
return SSP_CLK / (div * (1 + rate));
}
static void
imx23_mmc_dma_intr(void *arg)
{
struct imx23_mmc_softc *sc = arg;
mutex_enter(&sc->sc_lock);
sc->sc_state = SSP_STATE_IDLE;
cv_signal(&sc->sc_intr_cv);
mutex_exit(&sc->sc_lock);
}
static int
imx23_mmc_error_intr(void *arg)
{
struct imx23_mmc_softc *sc = arg;
mutex_enter(&sc->sc_lock);
sc->sc_irq_error =
SSP_RD(sc, HW_SSP_CTRL1) & HW_SSP_CTRL1_IRQ_MASK;
SSP_WR(sc, HW_SSP_CTRL1_CLR, HW_SSP_CTRL1_IRQ_MASK);
mutex_exit(&sc->sc_lock);
return 1;
}
static void
imx23_mmc_prepare_data_command(struct imx23_mmc_softc *sc,
struct fdtbus_dma_req *req, struct sdmmc_command *cmd)
{
int block_count = cmd->c_datalen / cmd->c_blklen;
req->dreq_segs = cmd->c_dmamap->dm_segs;
req->dreq_nsegs = cmd->c_dmamap->dm_nsegs;
req->dreq_block_irq = 1;
req->dreq_block_multi = 0;
req->dreq_datalen = 3;
req->dreq_data = sc->pio_words;
sc->pio_words[PIO_WORD_CTRL0] =
HW_SSP_CTRL0_DATA_XFER |
__SHIFTIN(sc->sc_bus_width, HW_SSP_CTRL0_BUS_WIDTH) |
HW_SSP_CTRL0_WAIT_FOR_IRQ |
__SHIFTIN(cmd->c_datalen, HW_SSP_CTRL0_XFER_COUNT) |
HW_SSP_CTRL0_ENABLE;
if (ISSET(cmd->c_flags, SCF_CMD_READ)) {
req->dreq_dir = FDT_DMA_READ;
sc->pio_words[PIO_WORD_CTRL0] |= HW_SSP_CTRL0_READ;
} else {
req->dreq_dir = FDT_DMA_WRITE;
}
if (!ISSET(cmd->c_flags, SCF_RSP_CRC)) {
sc->pio_words[PIO_WORD_CTRL0] |= HW_SSP_CTRL0_IGNORE_CRC;
}
if (ISSET(cmd->c_flags, SCF_RSP_PRESENT)) {
sc->pio_words[PIO_WORD_CTRL0] |= HW_SSP_CTRL0_GET_RESP;
if (ISSET(cmd->c_flags, SCF_RSP_136)) {
sc->pio_words[PIO_WORD_CTRL0] |= HW_SSP_CTRL0_LONG_RESP;
}
}
sc->pio_words[PIO_WORD_CMD0] =
HW_SSP_CMD0_APPEND_8CYC |
__SHIFTIN(ffs(cmd->c_blklen) - 1, HW_SSP_CMD0_BLOCK_SIZE) |
__SHIFTIN(block_count - 1, HW_SSP_CMD0_BLOCK_COUNT) |
__SHIFTIN(cmd->c_opcode, HW_SSP_CMD0_CMD);
sc->pio_words[PIO_WORD_CMD1] = cmd->c_arg;
}
static void
imx23_mmc_prepare_command(struct imx23_mmc_softc *sc,
struct fdtbus_dma_req *req, struct sdmmc_command *cmd)
{
req->dreq_nsegs = 0;
req->dreq_block_irq = 1;
req->dreq_block_multi = 0;
req->dreq_dir = FDT_DMA_NO_XFER;
req->dreq_datalen = 3;
req->dreq_data = sc->pio_words;
sc->pio_words[PIO_WORD_CTRL0] =
__SHIFTIN(sc->sc_bus_width, HW_SSP_CTRL0_BUS_WIDTH) |
HW_SSP_CTRL0_WAIT_FOR_IRQ | HW_SSP_CTRL0_ENABLE;
if (!ISSET(cmd->c_flags, SCF_RSP_CRC)) {
sc->pio_words[PIO_WORD_CTRL0] |= HW_SSP_CTRL0_IGNORE_CRC;
}
if (ISSET(cmd->c_flags, SCF_RSP_PRESENT)) {
sc->pio_words[PIO_WORD_CTRL0] |= HW_SSP_CTRL0_GET_RESP;
if (ISSET(cmd->c_flags, SCF_RSP_136)) {
sc->pio_words[PIO_WORD_CTRL0] |= HW_SSP_CTRL0_LONG_RESP;
}
}
sc->pio_words[PIO_WORD_CMD0] =
__SHIFTIN(cmd->c_opcode, HW_SSP_CMD0_CMD);
sc->pio_words[PIO_WORD_CMD1] = cmd->c_arg;
}