1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * jmb38x_ms.c - JMicron jmb38x MemoryStick card reader 4 * 5 * Copyright (C) 2008 Alex Dubov <oakad@yahoo.com> 6 */ 7 8 #include <linux/spinlock.h> 9 #include <linux/interrupt.h> 10 #include <linux/pci.h> 11 #include <linux/dma-mapping.h> 12 #include <linux/delay.h> 13 #include <linux/highmem.h> 14 #include <linux/memstick.h> 15 #include <linux/slab.h> 16 #include <linux/module.h> 17 18 #define DRIVER_NAME "jmb38x_ms" 19 20 static bool no_dma; 21 module_param(no_dma, bool, 0644); 22 23 enum { 24 DMA_ADDRESS = 0x00, 25 BLOCK = 0x04, 26 DMA_CONTROL = 0x08, 27 TPC_P0 = 0x0c, 28 TPC_P1 = 0x10, 29 TPC = 0x14, 30 HOST_CONTROL = 0x18, 31 DATA = 0x1c, 32 STATUS = 0x20, 33 INT_STATUS = 0x24, 34 INT_STATUS_ENABLE = 0x28, 35 INT_SIGNAL_ENABLE = 0x2c, 36 TIMER = 0x30, 37 TIMER_CONTROL = 0x34, 38 PAD_OUTPUT_ENABLE = 0x38, 39 PAD_PU_PD = 0x3c, 40 CLOCK_DELAY = 0x40, 41 ADMA_ADDRESS = 0x44, 42 CLOCK_CONTROL = 0x48, 43 LED_CONTROL = 0x4c, 44 VERSION = 0x50 45 }; 46 47 struct jmb38x_ms_host { 48 struct jmb38x_ms *chip; 49 void __iomem *addr; 50 spinlock_t lock; 51 struct tasklet_struct notify; 52 int id; 53 char host_id[32]; 54 int irq; 55 unsigned int block_pos; 56 unsigned long timeout_jiffies; 57 struct timer_list timer; 58 struct memstick_host *msh; 59 struct memstick_request *req; 60 unsigned char cmd_flags; 61 unsigned char io_pos; 62 unsigned char ifmode; 63 unsigned int io_word[2]; 64 }; 65 66 struct jmb38x_ms { 67 struct pci_dev *pdev; 68 int host_cnt; 69 struct memstick_host *hosts[]; 70 }; 71 72 #define BLOCK_COUNT_MASK 0xffff0000 73 #define BLOCK_SIZE_MASK 0x00000fff 74 75 #define DMA_CONTROL_ENABLE 0x00000001 76 77 #define TPC_DATA_SEL 0x00008000 78 #define TPC_DIR 0x00004000 79 #define TPC_WAIT_INT 0x00002000 80 #define TPC_GET_INT 0x00000800 81 #define TPC_CODE_SZ_MASK 0x00000700 82 #define TPC_DATA_SZ_MASK 0x00000007 83 84 #define HOST_CONTROL_TDELAY_EN 0x00040000 85 #define HOST_CONTROL_HW_OC_P 0x00010000 86 #define HOST_CONTROL_RESET_REQ 0x00008000 87 #define HOST_CONTROL_REI 0x00004000 88 #define HOST_CONTROL_LED 0x00000400 89 #define HOST_CONTROL_FAST_CLK 0x00000200 90 #define HOST_CONTROL_RESET 0x00000100 91 #define HOST_CONTROL_POWER_EN 0x00000080 92 #define HOST_CONTROL_CLOCK_EN 0x00000040 93 #define HOST_CONTROL_REO 0x00000008 94 #define HOST_CONTROL_IF_SHIFT 4 95 96 #define HOST_CONTROL_IF_SERIAL 0x0 97 #define HOST_CONTROL_IF_PAR4 0x1 98 #define HOST_CONTROL_IF_PAR8 0x3 99 100 #define STATUS_BUSY 0x00080000 101 #define STATUS_MS_DAT7 0x00040000 102 #define STATUS_MS_DAT6 0x00020000 103 #define STATUS_MS_DAT5 0x00010000 104 #define STATUS_MS_DAT4 0x00008000 105 #define STATUS_MS_DAT3 0x00004000 106 #define STATUS_MS_DAT2 0x00002000 107 #define STATUS_MS_DAT1 0x00001000 108 #define STATUS_MS_DAT0 0x00000800 109 #define STATUS_HAS_MEDIA 0x00000400 110 #define STATUS_FIFO_EMPTY 0x00000200 111 #define STATUS_FIFO_FULL 0x00000100 112 #define STATUS_MS_CED 0x00000080 113 #define STATUS_MS_ERR 0x00000040 114 #define STATUS_MS_BRQ 0x00000020 115 #define STATUS_MS_CNK 0x00000001 116 117 #define INT_STATUS_TPC_ERR 0x00080000 118 #define INT_STATUS_CRC_ERR 0x00040000 119 #define INT_STATUS_TIMER_TO 0x00020000 120 #define INT_STATUS_HSK_TO 0x00010000 121 #define INT_STATUS_ANY_ERR 0x00008000 122 #define INT_STATUS_FIFO_WRDY 0x00000080 123 #define INT_STATUS_FIFO_RRDY 0x00000040 124 #define INT_STATUS_MEDIA_OUT 0x00000010 125 #define INT_STATUS_MEDIA_IN 0x00000008 126 #define INT_STATUS_DMA_BOUNDARY 0x00000004 127 #define INT_STATUS_EOTRAN 0x00000002 128 #define INT_STATUS_EOTPC 0x00000001 129 130 #define INT_STATUS_ALL 0x000f801f 131 132 #define PAD_OUTPUT_ENABLE_MS 0x0F3F 133 134 #define PAD_PU_PD_OFF 0x7FFF0000 135 #define PAD_PU_PD_ON_MS_SOCK0 0x5f8f0000 136 #define PAD_PU_PD_ON_MS_SOCK1 0x0f0f0000 137 138 #define CLOCK_CONTROL_BY_MMIO 0x00000008 139 #define CLOCK_CONTROL_40MHZ 0x00000001 140 #define CLOCK_CONTROL_50MHZ 0x00000002 141 #define CLOCK_CONTROL_60MHZ 0x00000010 142 #define CLOCK_CONTROL_62_5MHZ 0x00000004 143 #define CLOCK_CONTROL_OFF 0x00000000 144 145 #define PCI_CTL_CLOCK_DLY_ADDR 0x000000b0 146 147 enum { 148 CMD_READY = 0x01, 149 FIFO_READY = 0x02, 150 REG_DATA = 0x04, 151 DMA_DATA = 0x08 152 }; 153 154 static unsigned int jmb38x_ms_read_data(struct jmb38x_ms_host *host, 155 unsigned char *buf, unsigned int length) 156 { 157 unsigned int off = 0; 158 159 while (host->io_pos && length) { 160 buf[off++] = host->io_word[0] & 0xff; 161 host->io_word[0] >>= 8; 162 length--; 163 host->io_pos--; 164 } 165 166 if (!length) 167 return off; 168 169 while (!(STATUS_FIFO_EMPTY & readl(host->addr + STATUS))) { 170 if (length < 4) 171 break; 172 *(unsigned int *)(buf + off) = __raw_readl(host->addr + DATA); 173 length -= 4; 174 off += 4; 175 } 176 177 if (length 178 && !(STATUS_FIFO_EMPTY & readl(host->addr + STATUS))) { 179 host->io_word[0] = readl(host->addr + DATA); 180 for (host->io_pos = 4; host->io_pos; --host->io_pos) { 181 buf[off++] = host->io_word[0] & 0xff; 182 host->io_word[0] >>= 8; 183 length--; 184 if (!length) 185 break; 186 } 187 } 188 189 return off; 190 } 191 192 static unsigned int jmb38x_ms_read_reg_data(struct jmb38x_ms_host *host, 193 unsigned char *buf, 194 unsigned int length) 195 { 196 unsigned int off = 0; 197 198 while (host->io_pos > 4 && length) { 199 buf[off++] = host->io_word[0] & 0xff; 200 host->io_word[0] >>= 8; 201 length--; 202 host->io_pos--; 203 } 204 205 if (!length) 206 return off; 207 208 while (host->io_pos && length) { 209 buf[off++] = host->io_word[1] & 0xff; 210 host->io_word[1] >>= 8; 211 length--; 212 host->io_pos--; 213 } 214 215 return off; 216 } 217 218 static unsigned int jmb38x_ms_write_data(struct jmb38x_ms_host *host, 219 unsigned char *buf, 220 unsigned int length) 221 { 222 unsigned int off = 0; 223 224 if (host->io_pos) { 225 while (host->io_pos < 4 && length) { 226 host->io_word[0] |= buf[off++] << (host->io_pos * 8); 227 host->io_pos++; 228 length--; 229 } 230 } 231 232 if (host->io_pos == 4 233 && !(STATUS_FIFO_FULL & readl(host->addr + STATUS))) { 234 writel(host->io_word[0], host->addr + DATA); 235 host->io_pos = 0; 236 host->io_word[0] = 0; 237 } else if (host->io_pos) { 238 return off; 239 } 240 241 if (!length) 242 return off; 243 244 while (!(STATUS_FIFO_FULL & readl(host->addr + STATUS))) { 245 if (length < 4) 246 break; 247 248 __raw_writel(*(unsigned int *)(buf + off), 249 host->addr + DATA); 250 length -= 4; 251 off += 4; 252 } 253 254 switch (length) { 255 case 3: 256 host->io_word[0] |= buf[off + 2] << 16; 257 host->io_pos++; 258 /* fall through */ 259 case 2: 260 host->io_word[0] |= buf[off + 1] << 8; 261 host->io_pos++; 262 /* fall through */ 263 case 1: 264 host->io_word[0] |= buf[off]; 265 host->io_pos++; 266 } 267 268 off += host->io_pos; 269 270 return off; 271 } 272 273 static unsigned int jmb38x_ms_write_reg_data(struct jmb38x_ms_host *host, 274 unsigned char *buf, 275 unsigned int length) 276 { 277 unsigned int off = 0; 278 279 while (host->io_pos < 4 && length) { 280 host->io_word[0] &= ~(0xff << (host->io_pos * 8)); 281 host->io_word[0] |= buf[off++] << (host->io_pos * 8); 282 host->io_pos++; 283 length--; 284 } 285 286 if (!length) 287 return off; 288 289 while (host->io_pos < 8 && length) { 290 host->io_word[1] &= ~(0xff << (host->io_pos * 8)); 291 host->io_word[1] |= buf[off++] << (host->io_pos * 8); 292 host->io_pos++; 293 length--; 294 } 295 296 return off; 297 } 298 299 static int jmb38x_ms_transfer_data(struct jmb38x_ms_host *host) 300 { 301 unsigned int length; 302 unsigned int off; 303 unsigned int t_size, p_cnt; 304 unsigned char *buf; 305 struct page *pg; 306 unsigned long flags = 0; 307 308 if (host->req->long_data) { 309 length = host->req->sg.length - host->block_pos; 310 off = host->req->sg.offset + host->block_pos; 311 } else { 312 length = host->req->data_len - host->block_pos; 313 off = 0; 314 } 315 316 while (length) { 317 unsigned int uninitialized_var(p_off); 318 319 if (host->req->long_data) { 320 pg = nth_page(sg_page(&host->req->sg), 321 off >> PAGE_SHIFT); 322 p_off = offset_in_page(off); 323 p_cnt = PAGE_SIZE - p_off; 324 p_cnt = min(p_cnt, length); 325 326 local_irq_save(flags); 327 buf = kmap_atomic(pg) + p_off; 328 } else { 329 buf = host->req->data + host->block_pos; 330 p_cnt = host->req->data_len - host->block_pos; 331 } 332 333 if (host->req->data_dir == WRITE) 334 t_size = !(host->cmd_flags & REG_DATA) 335 ? jmb38x_ms_write_data(host, buf, p_cnt) 336 : jmb38x_ms_write_reg_data(host, buf, p_cnt); 337 else 338 t_size = !(host->cmd_flags & REG_DATA) 339 ? jmb38x_ms_read_data(host, buf, p_cnt) 340 : jmb38x_ms_read_reg_data(host, buf, p_cnt); 341 342 if (host->req->long_data) { 343 kunmap_atomic(buf - p_off); 344 local_irq_restore(flags); 345 } 346 347 if (!t_size) 348 break; 349 host->block_pos += t_size; 350 length -= t_size; 351 off += t_size; 352 } 353 354 if (!length && host->req->data_dir == WRITE) { 355 if (host->cmd_flags & REG_DATA) { 356 writel(host->io_word[0], host->addr + TPC_P0); 357 writel(host->io_word[1], host->addr + TPC_P1); 358 } else if (host->io_pos) { 359 writel(host->io_word[0], host->addr + DATA); 360 } 361 } 362 363 return length; 364 } 365 366 static int jmb38x_ms_issue_cmd(struct memstick_host *msh) 367 { 368 struct jmb38x_ms_host *host = memstick_priv(msh); 369 unsigned int data_len, cmd, t_val; 370 371 if (!(STATUS_HAS_MEDIA & readl(host->addr + STATUS))) { 372 dev_dbg(&msh->dev, "no media status\n"); 373 host->req->error = -ETIME; 374 return host->req->error; 375 } 376 377 dev_dbg(&msh->dev, "control %08x\n", readl(host->addr + HOST_CONTROL)); 378 dev_dbg(&msh->dev, "status %08x\n", readl(host->addr + INT_STATUS)); 379 dev_dbg(&msh->dev, "hstatus %08x\n", readl(host->addr + STATUS)); 380 381 host->cmd_flags = 0; 382 host->block_pos = 0; 383 host->io_pos = 0; 384 host->io_word[0] = 0; 385 host->io_word[1] = 0; 386 387 cmd = host->req->tpc << 16; 388 cmd |= TPC_DATA_SEL; 389 390 if (host->req->data_dir == READ) 391 cmd |= TPC_DIR; 392 393 if (host->req->need_card_int) { 394 if (host->ifmode == MEMSTICK_SERIAL) 395 cmd |= TPC_GET_INT; 396 else 397 cmd |= TPC_WAIT_INT; 398 } 399 400 if (!no_dma) 401 host->cmd_flags |= DMA_DATA; 402 403 if (host->req->long_data) { 404 data_len = host->req->sg.length; 405 } else { 406 data_len = host->req->data_len; 407 host->cmd_flags &= ~DMA_DATA; 408 } 409 410 if (data_len <= 8) { 411 cmd &= ~(TPC_DATA_SEL | 0xf); 412 host->cmd_flags |= REG_DATA; 413 cmd |= data_len & 0xf; 414 host->cmd_flags &= ~DMA_DATA; 415 } 416 417 if (host->cmd_flags & DMA_DATA) { 418 if (1 != dma_map_sg(&host->chip->pdev->dev, &host->req->sg, 1, 419 host->req->data_dir == READ 420 ? DMA_FROM_DEVICE 421 : DMA_TO_DEVICE)) { 422 host->req->error = -ENOMEM; 423 return host->req->error; 424 } 425 data_len = sg_dma_len(&host->req->sg); 426 writel(sg_dma_address(&host->req->sg), 427 host->addr + DMA_ADDRESS); 428 writel(((1 << 16) & BLOCK_COUNT_MASK) 429 | (data_len & BLOCK_SIZE_MASK), 430 host->addr + BLOCK); 431 writel(DMA_CONTROL_ENABLE, host->addr + DMA_CONTROL); 432 } else if (!(host->cmd_flags & REG_DATA)) { 433 writel(((1 << 16) & BLOCK_COUNT_MASK) 434 | (data_len & BLOCK_SIZE_MASK), 435 host->addr + BLOCK); 436 t_val = readl(host->addr + INT_STATUS_ENABLE); 437 t_val |= host->req->data_dir == READ 438 ? INT_STATUS_FIFO_RRDY 439 : INT_STATUS_FIFO_WRDY; 440 441 writel(t_val, host->addr + INT_STATUS_ENABLE); 442 writel(t_val, host->addr + INT_SIGNAL_ENABLE); 443 } else { 444 cmd &= ~(TPC_DATA_SEL | 0xf); 445 host->cmd_flags |= REG_DATA; 446 cmd |= data_len & 0xf; 447 448 if (host->req->data_dir == WRITE) { 449 jmb38x_ms_transfer_data(host); 450 writel(host->io_word[0], host->addr + TPC_P0); 451 writel(host->io_word[1], host->addr + TPC_P1); 452 } 453 } 454 455 mod_timer(&host->timer, jiffies + host->timeout_jiffies); 456 writel(HOST_CONTROL_LED | readl(host->addr + HOST_CONTROL), 457 host->addr + HOST_CONTROL); 458 host->req->error = 0; 459 460 writel(cmd, host->addr + TPC); 461 dev_dbg(&msh->dev, "executing TPC %08x, len %x\n", cmd, data_len); 462 463 return 0; 464 } 465 466 static void jmb38x_ms_complete_cmd(struct memstick_host *msh, int last) 467 { 468 struct jmb38x_ms_host *host = memstick_priv(msh); 469 unsigned int t_val = 0; 470 int rc; 471 472 del_timer(&host->timer); 473 474 dev_dbg(&msh->dev, "c control %08x\n", 475 readl(host->addr + HOST_CONTROL)); 476 dev_dbg(&msh->dev, "c status %08x\n", 477 readl(host->addr + INT_STATUS)); 478 dev_dbg(&msh->dev, "c hstatus %08x\n", readl(host->addr + STATUS)); 479 480 host->req->int_reg = readl(host->addr + STATUS) & 0xff; 481 482 writel(0, host->addr + BLOCK); 483 writel(0, host->addr + DMA_CONTROL); 484 485 if (host->cmd_flags & DMA_DATA) { 486 dma_unmap_sg(&host->chip->pdev->dev, &host->req->sg, 1, 487 host->req->data_dir == READ 488 ? DMA_FROM_DEVICE : DMA_TO_DEVICE); 489 } else { 490 t_val = readl(host->addr + INT_STATUS_ENABLE); 491 if (host->req->data_dir == READ) 492 t_val &= ~INT_STATUS_FIFO_RRDY; 493 else 494 t_val &= ~INT_STATUS_FIFO_WRDY; 495 496 writel(t_val, host->addr + INT_STATUS_ENABLE); 497 writel(t_val, host->addr + INT_SIGNAL_ENABLE); 498 } 499 500 writel((~HOST_CONTROL_LED) & readl(host->addr + HOST_CONTROL), 501 host->addr + HOST_CONTROL); 502 503 if (!last) { 504 do { 505 rc = memstick_next_req(msh, &host->req); 506 } while (!rc && jmb38x_ms_issue_cmd(msh)); 507 } else { 508 do { 509 rc = memstick_next_req(msh, &host->req); 510 if (!rc) 511 host->req->error = -ETIME; 512 } while (!rc); 513 } 514 } 515 516 static irqreturn_t jmb38x_ms_isr(int irq, void *dev_id) 517 { 518 struct memstick_host *msh = dev_id; 519 struct jmb38x_ms_host *host = memstick_priv(msh); 520 unsigned int irq_status; 521 522 spin_lock(&host->lock); 523 irq_status = readl(host->addr + INT_STATUS); 524 dev_dbg(&host->chip->pdev->dev, "irq_status = %08x\n", irq_status); 525 if (irq_status == 0 || irq_status == (~0)) { 526 spin_unlock(&host->lock); 527 return IRQ_NONE; 528 } 529 530 if (host->req) { 531 if (irq_status & INT_STATUS_ANY_ERR) { 532 if (irq_status & INT_STATUS_CRC_ERR) 533 host->req->error = -EILSEQ; 534 else if (irq_status & INT_STATUS_TPC_ERR) { 535 dev_dbg(&host->chip->pdev->dev, "TPC_ERR\n"); 536 jmb38x_ms_complete_cmd(msh, 0); 537 } else 538 host->req->error = -ETIME; 539 } else { 540 if (host->cmd_flags & DMA_DATA) { 541 if (irq_status & INT_STATUS_EOTRAN) 542 host->cmd_flags |= FIFO_READY; 543 } else { 544 if (irq_status & (INT_STATUS_FIFO_RRDY 545 | INT_STATUS_FIFO_WRDY)) 546 jmb38x_ms_transfer_data(host); 547 548 if (irq_status & INT_STATUS_EOTRAN) { 549 jmb38x_ms_transfer_data(host); 550 host->cmd_flags |= FIFO_READY; 551 } 552 } 553 554 if (irq_status & INT_STATUS_EOTPC) { 555 host->cmd_flags |= CMD_READY; 556 if (host->cmd_flags & REG_DATA) { 557 if (host->req->data_dir == READ) { 558 host->io_word[0] 559 = readl(host->addr 560 + TPC_P0); 561 host->io_word[1] 562 = readl(host->addr 563 + TPC_P1); 564 host->io_pos = 8; 565 566 jmb38x_ms_transfer_data(host); 567 } 568 host->cmd_flags |= FIFO_READY; 569 } 570 } 571 } 572 } 573 574 if (irq_status & (INT_STATUS_MEDIA_IN | INT_STATUS_MEDIA_OUT)) { 575 dev_dbg(&host->chip->pdev->dev, "media changed\n"); 576 memstick_detect_change(msh); 577 } 578 579 writel(irq_status, host->addr + INT_STATUS); 580 581 if (host->req 582 && (((host->cmd_flags & CMD_READY) 583 && (host->cmd_flags & FIFO_READY)) 584 || host->req->error)) 585 jmb38x_ms_complete_cmd(msh, 0); 586 587 spin_unlock(&host->lock); 588 return IRQ_HANDLED; 589 } 590 591 static void jmb38x_ms_abort(struct timer_list *t) 592 { 593 struct jmb38x_ms_host *host = from_timer(host, t, timer); 594 struct memstick_host *msh = host->msh; 595 unsigned long flags; 596 597 dev_dbg(&host->chip->pdev->dev, "abort\n"); 598 spin_lock_irqsave(&host->lock, flags); 599 if (host->req) { 600 host->req->error = -ETIME; 601 jmb38x_ms_complete_cmd(msh, 0); 602 } 603 spin_unlock_irqrestore(&host->lock, flags); 604 } 605 606 static void jmb38x_ms_req_tasklet(unsigned long data) 607 { 608 struct memstick_host *msh = (struct memstick_host *)data; 609 struct jmb38x_ms_host *host = memstick_priv(msh); 610 unsigned long flags; 611 int rc; 612 613 spin_lock_irqsave(&host->lock, flags); 614 if (!host->req) { 615 do { 616 rc = memstick_next_req(msh, &host->req); 617 dev_dbg(&host->chip->pdev->dev, "tasklet req %d\n", rc); 618 } while (!rc && jmb38x_ms_issue_cmd(msh)); 619 } 620 spin_unlock_irqrestore(&host->lock, flags); 621 } 622 623 static void jmb38x_ms_dummy_submit(struct memstick_host *msh) 624 { 625 return; 626 } 627 628 static void jmb38x_ms_submit_req(struct memstick_host *msh) 629 { 630 struct jmb38x_ms_host *host = memstick_priv(msh); 631 632 tasklet_schedule(&host->notify); 633 } 634 635 static int jmb38x_ms_reset(struct jmb38x_ms_host *host) 636 { 637 int cnt; 638 639 writel(HOST_CONTROL_RESET_REQ | HOST_CONTROL_CLOCK_EN 640 | readl(host->addr + HOST_CONTROL), 641 host->addr + HOST_CONTROL); 642 643 for (cnt = 0; cnt < 20; ++cnt) { 644 if (!(HOST_CONTROL_RESET_REQ 645 & readl(host->addr + HOST_CONTROL))) 646 goto reset_next; 647 648 ndelay(20); 649 } 650 dev_dbg(&host->chip->pdev->dev, "reset_req timeout\n"); 651 652 reset_next: 653 writel(HOST_CONTROL_RESET | HOST_CONTROL_CLOCK_EN 654 | readl(host->addr + HOST_CONTROL), 655 host->addr + HOST_CONTROL); 656 657 for (cnt = 0; cnt < 20; ++cnt) { 658 if (!(HOST_CONTROL_RESET 659 & readl(host->addr + HOST_CONTROL))) 660 goto reset_ok; 661 662 ndelay(20); 663 } 664 dev_dbg(&host->chip->pdev->dev, "reset timeout\n"); 665 return -EIO; 666 667 reset_ok: 668 writel(INT_STATUS_ALL, host->addr + INT_SIGNAL_ENABLE); 669 writel(INT_STATUS_ALL, host->addr + INT_STATUS_ENABLE); 670 return 0; 671 } 672 673 static int jmb38x_ms_set_param(struct memstick_host *msh, 674 enum memstick_param param, 675 int value) 676 { 677 struct jmb38x_ms_host *host = memstick_priv(msh); 678 unsigned int host_ctl = readl(host->addr + HOST_CONTROL); 679 unsigned int clock_ctl = CLOCK_CONTROL_BY_MMIO, clock_delay = 0; 680 int rc = 0; 681 682 switch (param) { 683 case MEMSTICK_POWER: 684 if (value == MEMSTICK_POWER_ON) { 685 rc = jmb38x_ms_reset(host); 686 if (rc) 687 return rc; 688 689 host_ctl = 7; 690 host_ctl |= HOST_CONTROL_POWER_EN 691 | HOST_CONTROL_CLOCK_EN; 692 writel(host_ctl, host->addr + HOST_CONTROL); 693 694 writel(host->id ? PAD_PU_PD_ON_MS_SOCK1 695 : PAD_PU_PD_ON_MS_SOCK0, 696 host->addr + PAD_PU_PD); 697 698 writel(PAD_OUTPUT_ENABLE_MS, 699 host->addr + PAD_OUTPUT_ENABLE); 700 701 msleep(10); 702 dev_dbg(&host->chip->pdev->dev, "power on\n"); 703 } else if (value == MEMSTICK_POWER_OFF) { 704 host_ctl &= ~(HOST_CONTROL_POWER_EN 705 | HOST_CONTROL_CLOCK_EN); 706 writel(host_ctl, host->addr + HOST_CONTROL); 707 writel(0, host->addr + PAD_OUTPUT_ENABLE); 708 writel(PAD_PU_PD_OFF, host->addr + PAD_PU_PD); 709 dev_dbg(&host->chip->pdev->dev, "power off\n"); 710 } else 711 return -EINVAL; 712 break; 713 case MEMSTICK_INTERFACE: 714 dev_dbg(&host->chip->pdev->dev, 715 "Set Host Interface Mode to %d\n", value); 716 host_ctl &= ~(HOST_CONTROL_FAST_CLK | HOST_CONTROL_REI | 717 HOST_CONTROL_REO); 718 host_ctl |= HOST_CONTROL_TDELAY_EN | HOST_CONTROL_HW_OC_P; 719 host_ctl &= ~(3 << HOST_CONTROL_IF_SHIFT); 720 721 if (value == MEMSTICK_SERIAL) { 722 host_ctl |= HOST_CONTROL_IF_SERIAL 723 << HOST_CONTROL_IF_SHIFT; 724 host_ctl |= HOST_CONTROL_REI; 725 clock_ctl |= CLOCK_CONTROL_40MHZ; 726 clock_delay = 0; 727 } else if (value == MEMSTICK_PAR4) { 728 host_ctl |= HOST_CONTROL_FAST_CLK; 729 host_ctl |= HOST_CONTROL_IF_PAR4 730 << HOST_CONTROL_IF_SHIFT; 731 host_ctl |= HOST_CONTROL_REO; 732 clock_ctl |= CLOCK_CONTROL_40MHZ; 733 clock_delay = 4; 734 } else if (value == MEMSTICK_PAR8) { 735 host_ctl |= HOST_CONTROL_FAST_CLK; 736 host_ctl |= HOST_CONTROL_IF_PAR8 737 << HOST_CONTROL_IF_SHIFT; 738 clock_ctl |= CLOCK_CONTROL_50MHZ; 739 clock_delay = 0; 740 } else 741 return -EINVAL; 742 743 writel(host_ctl, host->addr + HOST_CONTROL); 744 writel(CLOCK_CONTROL_OFF, host->addr + CLOCK_CONTROL); 745 writel(clock_ctl, host->addr + CLOCK_CONTROL); 746 pci_write_config_byte(host->chip->pdev, 747 PCI_CTL_CLOCK_DLY_ADDR + 1, 748 clock_delay); 749 host->ifmode = value; 750 break; 751 }; 752 return 0; 753 } 754 755 #define PCI_PMOS0_CONTROL 0xae 756 #define PMOS0_ENABLE 0x01 757 #define PMOS0_OVERCURRENT_LEVEL_2_4V 0x06 758 #define PMOS0_EN_OVERCURRENT_DEBOUNCE 0x40 759 #define PMOS0_SW_LED_POLARITY_ENABLE 0x80 760 #define PMOS0_ACTIVE_BITS (PMOS0_ENABLE | PMOS0_EN_OVERCURRENT_DEBOUNCE | \ 761 PMOS0_OVERCURRENT_LEVEL_2_4V) 762 #define PCI_PMOS1_CONTROL 0xbd 763 #define PMOS1_ACTIVE_BITS 0x4a 764 #define PCI_CLOCK_CTL 0xb9 765 766 static int jmb38x_ms_pmos(struct pci_dev *pdev, int flag) 767 { 768 unsigned char val; 769 770 pci_read_config_byte(pdev, PCI_PMOS0_CONTROL, &val); 771 if (flag) 772 val |= PMOS0_ACTIVE_BITS; 773 else 774 val &= ~PMOS0_ACTIVE_BITS; 775 pci_write_config_byte(pdev, PCI_PMOS0_CONTROL, val); 776 dev_dbg(&pdev->dev, "JMB38x: set PMOS0 val 0x%x\n", val); 777 778 if (pci_resource_flags(pdev, 1)) { 779 pci_read_config_byte(pdev, PCI_PMOS1_CONTROL, &val); 780 if (flag) 781 val |= PMOS1_ACTIVE_BITS; 782 else 783 val &= ~PMOS1_ACTIVE_BITS; 784 pci_write_config_byte(pdev, PCI_PMOS1_CONTROL, val); 785 dev_dbg(&pdev->dev, "JMB38x: set PMOS1 val 0x%x\n", val); 786 } 787 788 pci_read_config_byte(pdev, PCI_CLOCK_CTL, &val); 789 pci_write_config_byte(pdev, PCI_CLOCK_CTL, val & ~0x0f); 790 pci_write_config_byte(pdev, PCI_CLOCK_CTL, val | 0x01); 791 dev_dbg(&pdev->dev, "Clock Control by PCI config is disabled!\n"); 792 793 return 0; 794 } 795 796 #ifdef CONFIG_PM 797 798 static int jmb38x_ms_suspend(struct pci_dev *dev, pm_message_t state) 799 { 800 struct jmb38x_ms *jm = pci_get_drvdata(dev); 801 int cnt; 802 803 for (cnt = 0; cnt < jm->host_cnt; ++cnt) { 804 if (!jm->hosts[cnt]) 805 break; 806 memstick_suspend_host(jm->hosts[cnt]); 807 } 808 809 pci_save_state(dev); 810 pci_enable_wake(dev, pci_choose_state(dev, state), 0); 811 pci_disable_device(dev); 812 pci_set_power_state(dev, pci_choose_state(dev, state)); 813 return 0; 814 } 815 816 static int jmb38x_ms_resume(struct pci_dev *dev) 817 { 818 struct jmb38x_ms *jm = pci_get_drvdata(dev); 819 int rc; 820 821 pci_set_power_state(dev, PCI_D0); 822 pci_restore_state(dev); 823 rc = pci_enable_device(dev); 824 if (rc) 825 return rc; 826 pci_set_master(dev); 827 828 jmb38x_ms_pmos(dev, 1); 829 830 for (rc = 0; rc < jm->host_cnt; ++rc) { 831 if (!jm->hosts[rc]) 832 break; 833 memstick_resume_host(jm->hosts[rc]); 834 memstick_detect_change(jm->hosts[rc]); 835 } 836 837 return 0; 838 } 839 840 #else 841 842 #define jmb38x_ms_suspend NULL 843 #define jmb38x_ms_resume NULL 844 845 #endif /* CONFIG_PM */ 846 847 static int jmb38x_ms_count_slots(struct pci_dev *pdev) 848 { 849 int cnt, rc = 0; 850 851 for (cnt = 0; cnt < PCI_ROM_RESOURCE; ++cnt) { 852 if (!(IORESOURCE_MEM & pci_resource_flags(pdev, cnt))) 853 break; 854 855 if (256 != pci_resource_len(pdev, cnt)) 856 break; 857 858 ++rc; 859 } 860 return rc; 861 } 862 863 static struct memstick_host *jmb38x_ms_alloc_host(struct jmb38x_ms *jm, int cnt) 864 { 865 struct memstick_host *msh; 866 struct jmb38x_ms_host *host; 867 868 msh = memstick_alloc_host(sizeof(struct jmb38x_ms_host), 869 &jm->pdev->dev); 870 if (!msh) 871 return NULL; 872 873 host = memstick_priv(msh); 874 host->msh = msh; 875 host->chip = jm; 876 host->addr = ioremap(pci_resource_start(jm->pdev, cnt), 877 pci_resource_len(jm->pdev, cnt)); 878 if (!host->addr) 879 goto err_out_free; 880 881 spin_lock_init(&host->lock); 882 host->id = cnt; 883 snprintf(host->host_id, sizeof(host->host_id), DRIVER_NAME ":slot%d", 884 host->id); 885 host->irq = jm->pdev->irq; 886 host->timeout_jiffies = msecs_to_jiffies(1000); 887 888 tasklet_init(&host->notify, jmb38x_ms_req_tasklet, (unsigned long)msh); 889 msh->request = jmb38x_ms_submit_req; 890 msh->set_param = jmb38x_ms_set_param; 891 892 msh->caps = MEMSTICK_CAP_PAR4 | MEMSTICK_CAP_PAR8; 893 894 timer_setup(&host->timer, jmb38x_ms_abort, 0); 895 896 if (!request_irq(host->irq, jmb38x_ms_isr, IRQF_SHARED, host->host_id, 897 msh)) 898 return msh; 899 900 iounmap(host->addr); 901 err_out_free: 902 kfree(msh); 903 return NULL; 904 } 905 906 static void jmb38x_ms_free_host(struct memstick_host *msh) 907 { 908 struct jmb38x_ms_host *host = memstick_priv(msh); 909 910 free_irq(host->irq, msh); 911 iounmap(host->addr); 912 memstick_free_host(msh); 913 } 914 915 static int jmb38x_ms_probe(struct pci_dev *pdev, 916 const struct pci_device_id *dev_id) 917 { 918 struct jmb38x_ms *jm; 919 int pci_dev_busy = 0; 920 int rc, cnt; 921 922 rc = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32)); 923 if (rc) 924 return rc; 925 926 rc = pci_enable_device(pdev); 927 if (rc) 928 return rc; 929 930 pci_set_master(pdev); 931 932 rc = pci_request_regions(pdev, DRIVER_NAME); 933 if (rc) { 934 pci_dev_busy = 1; 935 goto err_out; 936 } 937 938 jmb38x_ms_pmos(pdev, 1); 939 940 cnt = jmb38x_ms_count_slots(pdev); 941 if (!cnt) { 942 rc = -ENODEV; 943 pci_dev_busy = 1; 944 goto err_out_int; 945 } 946 947 jm = kzalloc(sizeof(struct jmb38x_ms) 948 + cnt * sizeof(struct memstick_host *), GFP_KERNEL); 949 if (!jm) { 950 rc = -ENOMEM; 951 goto err_out_int; 952 } 953 954 jm->pdev = pdev; 955 jm->host_cnt = cnt; 956 pci_set_drvdata(pdev, jm); 957 958 for (cnt = 0; cnt < jm->host_cnt; ++cnt) { 959 jm->hosts[cnt] = jmb38x_ms_alloc_host(jm, cnt); 960 if (!jm->hosts[cnt]) 961 break; 962 963 rc = memstick_add_host(jm->hosts[cnt]); 964 965 if (rc) { 966 jmb38x_ms_free_host(jm->hosts[cnt]); 967 jm->hosts[cnt] = NULL; 968 break; 969 } 970 } 971 972 if (cnt) 973 return 0; 974 975 rc = -ENODEV; 976 977 pci_set_drvdata(pdev, NULL); 978 kfree(jm); 979 err_out_int: 980 pci_release_regions(pdev); 981 err_out: 982 if (!pci_dev_busy) 983 pci_disable_device(pdev); 984 return rc; 985 } 986 987 static void jmb38x_ms_remove(struct pci_dev *dev) 988 { 989 struct jmb38x_ms *jm = pci_get_drvdata(dev); 990 struct jmb38x_ms_host *host; 991 int cnt; 992 unsigned long flags; 993 994 for (cnt = 0; cnt < jm->host_cnt; ++cnt) { 995 if (!jm->hosts[cnt]) 996 break; 997 998 host = memstick_priv(jm->hosts[cnt]); 999 1000 jm->hosts[cnt]->request = jmb38x_ms_dummy_submit; 1001 tasklet_kill(&host->notify); 1002 writel(0, host->addr + INT_SIGNAL_ENABLE); 1003 writel(0, host->addr + INT_STATUS_ENABLE); 1004 dev_dbg(&jm->pdev->dev, "interrupts off\n"); 1005 spin_lock_irqsave(&host->lock, flags); 1006 if (host->req) { 1007 host->req->error = -ETIME; 1008 jmb38x_ms_complete_cmd(jm->hosts[cnt], 1); 1009 } 1010 spin_unlock_irqrestore(&host->lock, flags); 1011 1012 memstick_remove_host(jm->hosts[cnt]); 1013 dev_dbg(&jm->pdev->dev, "host removed\n"); 1014 1015 jmb38x_ms_free_host(jm->hosts[cnt]); 1016 } 1017 1018 jmb38x_ms_pmos(dev, 0); 1019 1020 pci_set_drvdata(dev, NULL); 1021 pci_release_regions(dev); 1022 pci_disable_device(dev); 1023 kfree(jm); 1024 } 1025 1026 static struct pci_device_id jmb38x_ms_id_tbl [] = { 1027 { PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMB38X_MS) }, 1028 { PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMB385_MS) }, 1029 { PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMB390_MS) }, 1030 { } 1031 }; 1032 1033 static struct pci_driver jmb38x_ms_driver = { 1034 .name = DRIVER_NAME, 1035 .id_table = jmb38x_ms_id_tbl, 1036 .probe = jmb38x_ms_probe, 1037 .remove = jmb38x_ms_remove, 1038 .suspend = jmb38x_ms_suspend, 1039 .resume = jmb38x_ms_resume 1040 }; 1041 1042 module_pci_driver(jmb38x_ms_driver); 1043 1044 MODULE_AUTHOR("Alex Dubov"); 1045 MODULE_DESCRIPTION("JMicron jmb38x MemoryStick driver"); 1046 MODULE_LICENSE("GPL"); 1047 MODULE_DEVICE_TABLE(pci, jmb38x_ms_id_tbl); 1048