Lines Matching +full:x +full:- +full:rc
1 // SPDX-License-Identifier: GPL-2.0-only
11 #include <linux/blk-mq.h>
27 #define MSPRO_BLOCK_MAX_PAGES ((2 << 16) - 1)
182 struct mspro_block_data *msb = disk->private_data; in mspro_block_bd_free_disk()
195 struct mspro_block_data *msb = bdev->bd_disk->private_data; in mspro_block_bd_getgeo()
197 geo->heads = msb->heads; in mspro_block_bd_getgeo()
198 geo->sectors = msb->sectors_per_track; in mspro_block_bd_getgeo()
199 geo->cylinders = msb->cylinders; in mspro_block_bd_getgeo()
255 ssize_t cnt, rc = 0; in mspro_block_attr_show_default() local
257 for (cnt = 0; cnt < s_attr->size; cnt++) { in mspro_block_attr_show_default()
259 if (PAGE_SIZE - rc) in mspro_block_attr_show_default()
260 buffer[rc++] = '\n'; in mspro_block_attr_show_default()
263 rc += sysfs_emit_at(buffer, rc, "%02x ", in mspro_block_attr_show_default()
264 ((unsigned char *)s_attr->data)[cnt]); in mspro_block_attr_show_default()
266 return rc; in mspro_block_attr_show_default()
276 struct mspro_sys_info *x_sys = x_attr->data; in mspro_block_attr_show_sysinfo()
277 ssize_t rc = 0; in mspro_block_attr_show_sysinfo() local
280 if (x_sys->assembly_date[0] > 0x80U) { in mspro_block_attr_show_sysinfo()
281 date_tz = (~x_sys->assembly_date[0]) + 1; in mspro_block_attr_show_sysinfo()
284 date_tz = -date_tz; in mspro_block_attr_show_sysinfo()
286 } else if (x_sys->assembly_date[0] < 0x80U) { in mspro_block_attr_show_sysinfo()
287 date_tz = x_sys->assembly_date[0]; in mspro_block_attr_show_sysinfo()
293 rc += sysfs_emit_at(buffer, rc, "class: %x\n", x_sys->class); in mspro_block_attr_show_sysinfo()
294 rc += sysfs_emit_at(buffer, rc, "block size: %x\n", be16_to_cpu(x_sys->block_size)); in mspro_block_attr_show_sysinfo()
295 rc += sysfs_emit_at(buffer, rc, "block count: %x\n", be16_to_cpu(x_sys->block_count)); in mspro_block_attr_show_sysinfo()
296 rc += sysfs_emit_at(buffer, rc, "user block count: %x\n", in mspro_block_attr_show_sysinfo()
297 be16_to_cpu(x_sys->user_block_count)); in mspro_block_attr_show_sysinfo()
298 rc += sysfs_emit_at(buffer, rc, "page size: %x\n", be16_to_cpu(x_sys->page_size)); in mspro_block_attr_show_sysinfo()
299 rc += sysfs_emit_at(buffer, rc, "assembly date: GMT%+d:%d %04u-%02u-%02u %02u:%02u:%02u\n", in mspro_block_attr_show_sysinfo()
301 be16_to_cpup((__be16 *)&x_sys->assembly_date[1]), in mspro_block_attr_show_sysinfo()
302 x_sys->assembly_date[3], x_sys->assembly_date[4], in mspro_block_attr_show_sysinfo()
303 x_sys->assembly_date[5], x_sys->assembly_date[6], in mspro_block_attr_show_sysinfo()
304 x_sys->assembly_date[7]); in mspro_block_attr_show_sysinfo()
305 rc += sysfs_emit_at(buffer, rc, "serial number: %x\n", be32_to_cpu(x_sys->serial_number)); in mspro_block_attr_show_sysinfo()
306 rc += sysfs_emit_at(buffer, rc, "assembly maker code: %x\n", x_sys->assembly_maker_code); in mspro_block_attr_show_sysinfo()
307 rc += sysfs_emit_at(buffer, rc, "assembly model code: %02x%02x%02x\n", in mspro_block_attr_show_sysinfo()
308 x_sys->assembly_model_code[0], in mspro_block_attr_show_sysinfo()
309 x_sys->assembly_model_code[1], in mspro_block_attr_show_sysinfo()
310 x_sys->assembly_model_code[2]); in mspro_block_attr_show_sysinfo()
311 rc += sysfs_emit_at(buffer, rc, "memory maker code: %x\n", in mspro_block_attr_show_sysinfo()
312 be16_to_cpu(x_sys->memory_maker_code)); in mspro_block_attr_show_sysinfo()
313 rc += sysfs_emit_at(buffer, rc, "memory model code: %x\n", in mspro_block_attr_show_sysinfo()
314 be16_to_cpu(x_sys->memory_model_code)); in mspro_block_attr_show_sysinfo()
315 rc += sysfs_emit_at(buffer, rc, "vcc: %x\n", x_sys->vcc); in mspro_block_attr_show_sysinfo()
316 rc += sysfs_emit_at(buffer, rc, "vpp: %x\n", x_sys->vpp); in mspro_block_attr_show_sysinfo()
317 rc += sysfs_emit_at(buffer, rc, "controller number: %x\n", in mspro_block_attr_show_sysinfo()
318 be16_to_cpu(x_sys->controller_number)); in mspro_block_attr_show_sysinfo()
319 rc += sysfs_emit_at(buffer, rc, "controller function: %x\n", in mspro_block_attr_show_sysinfo()
320 be16_to_cpu(x_sys->controller_function)); in mspro_block_attr_show_sysinfo()
321 rc += sysfs_emit_at(buffer, rc, "start sector: %x\n", be16_to_cpu(x_sys->start_sector)); in mspro_block_attr_show_sysinfo()
322 rc += sysfs_emit_at(buffer, rc, "unit size: %x\n", be16_to_cpu(x_sys->unit_size)); in mspro_block_attr_show_sysinfo()
323 rc += sysfs_emit_at(buffer, rc, "sub class: %x\n", x_sys->ms_sub_class); in mspro_block_attr_show_sysinfo()
324 rc += sysfs_emit_at(buffer, rc, "interface type: %x\n", x_sys->interface_type); in mspro_block_attr_show_sysinfo()
325 rc += sysfs_emit_at(buffer, rc, "controller code: %x\n", in mspro_block_attr_show_sysinfo()
326 be16_to_cpu(x_sys->controller_code)); in mspro_block_attr_show_sysinfo()
327 rc += sysfs_emit_at(buffer, rc, "format type: %x\n", x_sys->format_type); in mspro_block_attr_show_sysinfo()
328 rc += sysfs_emit_at(buffer, rc, "device type: %x\n", x_sys->device_type); in mspro_block_attr_show_sysinfo()
329 rc += sysfs_emit_at(buffer, rc, "mspro id: %s\n", x_sys->mspro_id); in mspro_block_attr_show_sysinfo()
330 return rc; in mspro_block_attr_show_sysinfo()
341 return sysfs_emit(buffer, "%s", (char *)s_attr->data); in mspro_block_attr_show_modelname()
351 struct mspro_mbr *x_mbr = x_attr->data; in mspro_block_attr_show_mbr()
352 ssize_t rc = 0; in mspro_block_attr_show_mbr() local
354 rc += sysfs_emit_at(buffer, rc, "boot partition: %x\n", x_mbr->boot_partition); in mspro_block_attr_show_mbr()
355 rc += sysfs_emit_at(buffer, rc, "start head: %x\n", x_mbr->start_head); in mspro_block_attr_show_mbr()
356 rc += sysfs_emit_at(buffer, rc, "start sector: %x\n", x_mbr->start_sector); in mspro_block_attr_show_mbr()
357 rc += sysfs_emit_at(buffer, rc, "start cylinder: %x\n", x_mbr->start_cylinder); in mspro_block_attr_show_mbr()
358 rc += sysfs_emit_at(buffer, rc, "partition type: %x\n", x_mbr->partition_type); in mspro_block_attr_show_mbr()
359 rc += sysfs_emit_at(buffer, rc, "end head: %x\n", x_mbr->end_head); in mspro_block_attr_show_mbr()
360 rc += sysfs_emit_at(buffer, rc, "end sector: %x\n", x_mbr->end_sector); in mspro_block_attr_show_mbr()
361 rc += sysfs_emit_at(buffer, rc, "end cylinder: %x\n", x_mbr->end_cylinder); in mspro_block_attr_show_mbr()
362 rc += sysfs_emit_at(buffer, rc, "start sectors: %x\n", x_mbr->start_sectors); in mspro_block_attr_show_mbr()
363 rc += sysfs_emit_at(buffer, rc, "sectors per partition: %x\n", in mspro_block_attr_show_mbr()
364 x_mbr->sectors_per_partition); in mspro_block_attr_show_mbr()
365 return rc; in mspro_block_attr_show_mbr()
375 struct mspro_specfile *x_spfile = x_attr->data; in mspro_block_attr_show_specfile()
377 ssize_t rc = 0; in mspro_block_attr_show_specfile() local
379 memcpy(name, x_spfile->name, 8); in mspro_block_attr_show_specfile()
381 memcpy(ext, x_spfile->ext, 3); in mspro_block_attr_show_specfile()
384 rc += sysfs_emit_at(buffer, rc, "name: %s\n", name); in mspro_block_attr_show_specfile()
385 rc += sysfs_emit_at(buffer, rc, "ext: %s\n", ext); in mspro_block_attr_show_specfile()
386 rc += sysfs_emit_at(buffer, rc, "attribute: %x\n", x_spfile->attr); in mspro_block_attr_show_specfile()
387 rc += sysfs_emit_at(buffer, rc, "time: %d:%d:%d\n", in mspro_block_attr_show_specfile()
388 x_spfile->time >> 11, in mspro_block_attr_show_specfile()
389 (x_spfile->time >> 5) & 0x3f, in mspro_block_attr_show_specfile()
390 (x_spfile->time & 0x1f) * 2); in mspro_block_attr_show_specfile()
391 rc += sysfs_emit_at(buffer, rc, "date: %d-%d-%d\n", in mspro_block_attr_show_specfile()
392 (x_spfile->date >> 9) + 1980, in mspro_block_attr_show_specfile()
393 (x_spfile->date >> 5) & 0xf, in mspro_block_attr_show_specfile()
394 x_spfile->date & 0x1f); in mspro_block_attr_show_specfile()
395 rc += sysfs_emit_at(buffer, rc, "start cluster: %x\n", x_spfile->cluster); in mspro_block_attr_show_specfile()
396 rc += sysfs_emit_at(buffer, rc, "size: %x\n", x_spfile->size); in mspro_block_attr_show_specfile()
397 return rc; in mspro_block_attr_show_specfile()
407 struct mspro_devinfo *x_devinfo = x_attr->data; in mspro_block_attr_show_devinfo()
408 ssize_t rc = 0; in mspro_block_attr_show_devinfo() local
410 rc += sysfs_emit_at(buffer, rc, "cylinders: %x\n", be16_to_cpu(x_devinfo->cylinders)); in mspro_block_attr_show_devinfo()
411 rc += sysfs_emit_at(buffer, rc, "heads: %x\n", be16_to_cpu(x_devinfo->heads)); in mspro_block_attr_show_devinfo()
412 rc += sysfs_emit_at(buffer, rc, "bytes per track: %x\n", in mspro_block_attr_show_devinfo()
413 be16_to_cpu(x_devinfo->bytes_per_track)); in mspro_block_attr_show_devinfo()
414 rc += sysfs_emit_at(buffer, rc, "bytes per sector: %x\n", in mspro_block_attr_show_devinfo()
415 be16_to_cpu(x_devinfo->bytes_per_sector)); in mspro_block_attr_show_devinfo()
416 rc += sysfs_emit_at(buffer, rc, "sectors per track: %x\n", in mspro_block_attr_show_devinfo()
417 be16_to_cpu(x_devinfo->sectors_per_track)); in mspro_block_attr_show_devinfo()
418 return rc; in mspro_block_attr_show_devinfo()
445 * ongoing, while special error value of -EAGAIN means that current request is
454 *mrq = &card->current_mrq; in h_mspro_block_req_init()
455 card->next_request = msb->mrq_handler; in h_mspro_block_req_init()
462 return mspro_block_complete_req(card, (*mrq)->error); in h_mspro_block_default()
468 return -ENXIO; in h_mspro_block_default_bad()
476 if (!(*mrq)->error) { in h_mspro_block_get_ro()
477 if ((*mrq)->data[offsetof(struct ms_status_register, status0)] in h_mspro_block_get_ro()
479 msb->read_only = 1; in h_mspro_block_get_ro()
481 msb->read_only = 0; in h_mspro_block_get_ro()
484 return mspro_block_complete_req(card, (*mrq)->error); in h_mspro_block_get_ro()
490 dev_dbg(&card->dev, "wait for ced: value %x\n", (*mrq)->data[0]); in h_mspro_block_wait_for_ced()
492 if (!(*mrq)->error) { in h_mspro_block_wait_for_ced()
493 if ((*mrq)->data[0] & (MEMSTICK_INT_CMDNAK | MEMSTICK_INT_ERR)) in h_mspro_block_wait_for_ced()
494 (*mrq)->error = -EFAULT; in h_mspro_block_wait_for_ced()
495 else if (!((*mrq)->data[0] & MEMSTICK_INT_CED)) in h_mspro_block_wait_for_ced()
499 return mspro_block_complete_req(card, (*mrq)->error); in h_mspro_block_wait_for_ced()
510 if ((*mrq)->error) in h_mspro_block_transfer_data()
511 return mspro_block_complete_req(card, (*mrq)->error); in h_mspro_block_transfer_data()
513 switch ((*mrq)->tpc) { in h_mspro_block_transfer_data()
515 memstick_init_req(*mrq, MS_TPC_SET_CMD, &msb->transfer_cmd, 1); in h_mspro_block_transfer_data()
516 (*mrq)->need_card_int = 1; in h_mspro_block_transfer_data()
519 t_val = (*mrq)->int_reg; in h_mspro_block_transfer_data()
521 if (msb->caps & MEMSTICK_CAP_AUTO_GET_INT) in h_mspro_block_transfer_data()
525 t_val = (*mrq)->data[0]; in h_mspro_block_transfer_data()
530 card->next_request = h_mspro_block_default; in h_mspro_block_transfer_data()
534 if (msb->current_page in h_mspro_block_transfer_data()
535 == (msb->req_sg[msb->current_seg].length in h_mspro_block_transfer_data()
536 / msb->page_size)) { in h_mspro_block_transfer_data()
537 msb->current_page = 0; in h_mspro_block_transfer_data()
538 msb->current_seg++; in h_mspro_block_transfer_data()
540 if (msb->current_seg == msb->seg_count) { in h_mspro_block_transfer_data()
545 card->next_request in h_mspro_block_transfer_data()
559 t_offset = msb->req_sg[msb->current_seg].offset; in h_mspro_block_transfer_data()
560 t_offset += msb->current_page * msb->page_size; in h_mspro_block_transfer_data()
563 nth_page(sg_page(&(msb->req_sg[msb->current_seg])), in h_mspro_block_transfer_data()
565 msb->page_size, offset_in_page(t_offset)); in h_mspro_block_transfer_data()
567 memstick_init_req_sg(*mrq, msb->data_dir == READ in h_mspro_block_transfer_data()
571 (*mrq)->need_card_int = 1; in h_mspro_block_transfer_data()
575 msb->current_page++; in h_mspro_block_transfer_data()
576 if (msb->caps & MEMSTICK_CAP_AUTO_GET_INT) { in h_mspro_block_transfer_data()
577 t_val = (*mrq)->int_reg; in h_mspro_block_transfer_data()
603 .system = msb->system, in h_mspro_block_setup_cmd()
604 .data_count = cpu_to_be16((uint16_t)(length / msb->page_size)), in h_mspro_block_setup_cmd()
610 do_div(offset, msb->page_size); in h_mspro_block_setup_cmd()
613 card->next_request = h_mspro_block_req_init; in h_mspro_block_setup_cmd()
614 msb->mrq_handler = h_mspro_block_transfer_data; in h_mspro_block_setup_cmd()
615 memstick_init_req(&card->current_mrq, MS_TPC_WRITE_REG, in h_mspro_block_setup_cmd()
628 msb->current_page = 0; in mspro_block_issue_req()
629 msb->current_seg = 0; in mspro_block_issue_req()
630 msb->seg_count = blk_rq_map_sg(msb->block_req->q, in mspro_block_issue_req()
631 msb->block_req, in mspro_block_issue_req()
632 msb->req_sg); in mspro_block_issue_req()
634 if (!msb->seg_count) { in mspro_block_issue_req()
635 unsigned int bytes = blk_rq_cur_bytes(msb->block_req); in mspro_block_issue_req()
638 chunk = blk_update_request(msb->block_req, in mspro_block_issue_req()
643 __blk_mq_end_request(msb->block_req, in mspro_block_issue_req()
645 msb->block_req = NULL; in mspro_block_issue_req()
646 return -EAGAIN; in mspro_block_issue_req()
649 t_off = blk_rq_pos(msb->block_req); in mspro_block_issue_req()
651 count = blk_rq_bytes(msb->block_req); in mspro_block_issue_req()
653 msb->setup_transfer(card, t_off, count); in mspro_block_issue_req()
655 msb->data_dir = rq_data_dir(msb->block_req); in mspro_block_issue_req()
656 msb->transfer_cmd = msb->data_dir == READ in mspro_block_issue_req()
660 memstick_new_req(card->host); in mspro_block_issue_req()
673 spin_lock_irqsave(&msb->q_lock, flags); in mspro_block_complete_req()
674 dev_dbg(&card->dev, "complete %d, %d\n", msb->block_req ? 1 : 0, in mspro_block_complete_req()
677 if (msb->block_req) { in mspro_block_complete_req()
678 /* Nothing to do - not really an error */ in mspro_block_complete_req()
679 if (error == -EAGAIN) in mspro_block_complete_req()
682 if (error || (card->current_mrq.tpc == MSPRO_CMD_STOP)) { in mspro_block_complete_req()
683 if (msb->data_dir == READ) { in mspro_block_complete_req()
684 for (cnt = 0; cnt < msb->current_seg; cnt++) { in mspro_block_complete_req()
685 t_len += msb->req_sg[cnt].length in mspro_block_complete_req()
686 / msb->page_size; in mspro_block_complete_req()
688 if (msb->current_page) in mspro_block_complete_req()
689 t_len += msb->current_page - 1; in mspro_block_complete_req()
691 t_len *= msb->page_size; in mspro_block_complete_req()
695 t_len = blk_rq_bytes(msb->block_req); in mspro_block_complete_req()
697 dev_dbg(&card->dev, "transferred %x (%d)\n", t_len, error); in mspro_block_complete_req()
700 t_len = blk_rq_cur_bytes(msb->block_req); in mspro_block_complete_req()
702 chunk = blk_update_request(msb->block_req, in mspro_block_complete_req()
709 __blk_mq_end_request(msb->block_req, in mspro_block_complete_req()
711 msb->block_req = NULL; in mspro_block_complete_req()
715 error = -EAGAIN; in mspro_block_complete_req()
718 card->next_request = h_mspro_block_default_bad; in mspro_block_complete_req()
719 complete_all(&card->mrq_complete); in mspro_block_complete_req()
721 spin_unlock_irqrestore(&msb->q_lock, flags); in mspro_block_complete_req()
728 int rc = 0; in mspro_block_stop() local
732 spin_lock_irqsave(&msb->q_lock, flags); in mspro_block_stop()
733 if (!msb->block_req) { in mspro_block_stop()
734 blk_mq_stop_hw_queues(msb->queue); in mspro_block_stop()
735 rc = 1; in mspro_block_stop()
737 spin_unlock_irqrestore(&msb->q_lock, flags); in mspro_block_stop()
739 if (rc) in mspro_block_stop()
742 wait_for_completion(&card->mrq_complete); in mspro_block_stop()
750 blk_mq_start_hw_queues(msb->queue); in mspro_block_start()
756 struct memstick_dev *card = hctx->queue->queuedata; in mspro_queue_rq()
759 spin_lock_irq(&msb->q_lock); in mspro_queue_rq()
761 if (msb->block_req) { in mspro_queue_rq()
762 spin_unlock_irq(&msb->q_lock); in mspro_queue_rq()
766 if (msb->eject) { in mspro_queue_rq()
767 spin_unlock_irq(&msb->q_lock); in mspro_queue_rq()
768 blk_mq_start_request(bd->rq); in mspro_queue_rq()
772 msb->block_req = bd->rq; in mspro_queue_rq()
773 blk_mq_start_request(bd->rq); in mspro_queue_rq()
776 msb->block_req = NULL; in mspro_queue_rq()
778 spin_unlock_irq(&msb->q_lock); in mspro_queue_rq()
788 card->next_request = h_mspro_block_req_init; in mspro_block_wait_for_ced()
789 msb->mrq_handler = h_mspro_block_wait_for_ced; in mspro_block_wait_for_ced()
790 memstick_init_req(&card->current_mrq, MS_TPC_GET_INT, NULL, 1); in mspro_block_wait_for_ced()
791 memstick_new_req(card->host); in mspro_block_wait_for_ced()
792 wait_for_completion(&card->mrq_complete); in mspro_block_wait_for_ced()
793 return card->current_mrq.error; in mspro_block_wait_for_ced()
799 struct memstick_host *host = card->host; in mspro_block_set_interface()
808 card->next_request = h_mspro_block_req_init; in mspro_block_set_interface()
809 msb->mrq_handler = h_mspro_block_default; in mspro_block_set_interface()
810 memstick_init_req(&card->current_mrq, MS_TPC_WRITE_REG, ¶m, in mspro_block_set_interface()
813 wait_for_completion(&card->mrq_complete); in mspro_block_set_interface()
814 return card->current_mrq.error; in mspro_block_set_interface()
819 struct memstick_host *host = card->host; in mspro_block_switch_interface()
821 int rc = 0; in mspro_block_switch_interface() local
824 if (msb->caps & MEMSTICK_CAP_PAR4) in mspro_block_switch_interface()
825 rc = mspro_block_set_interface(card, MEMSTICK_SYS_PAR4); in mspro_block_switch_interface()
829 if (rc) { in mspro_block_switch_interface()
831 "%s: could not switch to 4-bit mode, error %d\n", in mspro_block_switch_interface()
832 dev_name(&card->dev), rc); in mspro_block_switch_interface()
836 msb->system = MEMSTICK_SYS_PAR4; in mspro_block_switch_interface()
837 host->set_param(host, MEMSTICK_INTERFACE, MEMSTICK_PAR4); in mspro_block_switch_interface()
838 printk(KERN_INFO "%s: switching to 4-bit parallel mode\n", in mspro_block_switch_interface()
839 dev_name(&card->dev)); in mspro_block_switch_interface()
841 if (msb->caps & MEMSTICK_CAP_PAR8) { in mspro_block_switch_interface()
842 rc = mspro_block_set_interface(card, MEMSTICK_SYS_PAR8); in mspro_block_switch_interface()
844 if (!rc) { in mspro_block_switch_interface()
845 msb->system = MEMSTICK_SYS_PAR8; in mspro_block_switch_interface()
846 host->set_param(host, MEMSTICK_INTERFACE, in mspro_block_switch_interface()
849 "%s: switching to 8-bit parallel mode\n", in mspro_block_switch_interface()
850 dev_name(&card->dev)); in mspro_block_switch_interface()
853 "%s: could not switch to 8-bit mode, error %d\n", in mspro_block_switch_interface()
854 dev_name(&card->dev), rc); in mspro_block_switch_interface()
857 card->next_request = h_mspro_block_req_init; in mspro_block_switch_interface()
858 msb->mrq_handler = h_mspro_block_default; in mspro_block_switch_interface()
859 memstick_init_req(&card->current_mrq, MS_TPC_GET_INT, NULL, 1); in mspro_block_switch_interface()
860 memstick_new_req(card->host); in mspro_block_switch_interface()
861 wait_for_completion(&card->mrq_complete); in mspro_block_switch_interface()
862 rc = card->current_mrq.error; in mspro_block_switch_interface()
864 if (rc) { in mspro_block_switch_interface()
867 dev_name(&card->dev)); in mspro_block_switch_interface()
868 msb->system = MEMSTICK_SYS_SERIAL; in mspro_block_switch_interface()
869 host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_OFF); in mspro_block_switch_interface()
871 host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_ON); in mspro_block_switch_interface()
872 host->set_param(host, MEMSTICK_INTERFACE, MEMSTICK_SERIAL); in mspro_block_switch_interface()
874 rc = memstick_set_rw_addr(card); in mspro_block_switch_interface()
875 if (!rc) in mspro_block_switch_interface()
876 rc = mspro_block_set_interface(card, msb->system); in mspro_block_switch_interface()
878 if (!rc) { in mspro_block_switch_interface()
880 rc = mspro_block_wait_for_ced(card); in mspro_block_switch_interface()
881 if (rc) in mspro_block_switch_interface()
882 return rc; in mspro_block_switch_interface()
884 if (msb->caps & MEMSTICK_CAP_PAR8) { in mspro_block_switch_interface()
885 msb->caps &= ~MEMSTICK_CAP_PAR8; in mspro_block_switch_interface()
890 return rc; in mspro_block_switch_interface()
903 int cnt, rc, attr_count; in mspro_block_read_attributes() local
909 unsigned int addr, attr_offset = 0, attr_len = msb->page_size; in mspro_block_read_attributes()
911 attr = kmalloc(msb->page_size, GFP_KERNEL); in mspro_block_read_attributes()
913 return -ENOMEM; in mspro_block_read_attributes()
915 sg_init_one(&msb->req_sg[0], attr, msb->page_size); in mspro_block_read_attributes()
916 msb->seg_count = 1; in mspro_block_read_attributes()
917 msb->current_seg = 0; in mspro_block_read_attributes()
918 msb->current_page = 0; in mspro_block_read_attributes()
919 msb->data_dir = READ; in mspro_block_read_attributes()
920 msb->transfer_cmd = MSPRO_CMD_READ_ATRB; in mspro_block_read_attributes()
922 msb->setup_transfer(card, attr_offset, attr_len); in mspro_block_read_attributes()
924 memstick_new_req(card->host); in mspro_block_read_attributes()
925 wait_for_completion(&card->mrq_complete); in mspro_block_read_attributes()
926 if (card->current_mrq.error) { in mspro_block_read_attributes()
927 rc = card->current_mrq.error; in mspro_block_read_attributes()
931 if (be16_to_cpu(attr->signature) != MSPRO_BLOCK_SIGNATURE) { in mspro_block_read_attributes()
932 printk(KERN_ERR "%s: unrecognized device signature %x\n", in mspro_block_read_attributes()
933 dev_name(&card->dev), be16_to_cpu(attr->signature)); in mspro_block_read_attributes()
934 rc = -ENODEV; in mspro_block_read_attributes()
938 if (attr->count > MSPRO_BLOCK_MAX_ATTRIBUTES) { in mspro_block_read_attributes()
940 dev_name(&card->dev)); in mspro_block_read_attributes()
943 attr_count = attr->count; in mspro_block_read_attributes()
945 msb->attr_group.attrs = kcalloc(attr_count + 1, in mspro_block_read_attributes()
946 sizeof(*msb->attr_group.attrs), in mspro_block_read_attributes()
948 if (!msb->attr_group.attrs) { in mspro_block_read_attributes()
949 rc = -ENOMEM; in mspro_block_read_attributes()
952 msb->attr_group.name = "media_attributes"; in mspro_block_read_attributes()
956 rc = -ENOMEM; in mspro_block_read_attributes()
963 rc = -ENOMEM; in mspro_block_read_attributes()
967 msb->attr_group.attrs[cnt] = &s_attr->dev_attr.attr; in mspro_block_read_attributes()
968 addr = be32_to_cpu(attr->entries[cnt].address); in mspro_block_read_attributes()
969 s_attr->size = be32_to_cpu(attr->entries[cnt].size); in mspro_block_read_attributes()
970 dev_dbg(&card->dev, "adding attribute %d: id %x, address %x, " in mspro_block_read_attributes()
971 "size %zx\n", cnt, attr->entries[cnt].id, addr, in mspro_block_read_attributes()
972 s_attr->size); in mspro_block_read_attributes()
973 s_attr->id = attr->entries[cnt].id; in mspro_block_read_attributes()
974 if (mspro_block_attr_name(s_attr->id)) in mspro_block_read_attributes()
975 snprintf(s_attr->name, sizeof(s_attr->name), "%s", in mspro_block_read_attributes()
976 mspro_block_attr_name(attr->entries[cnt].id)); in mspro_block_read_attributes()
978 snprintf(s_attr->name, sizeof(s_attr->name), in mspro_block_read_attributes()
979 "attr_x%02x", attr->entries[cnt].id); in mspro_block_read_attributes()
981 sysfs_attr_init(&s_attr->dev_attr.attr); in mspro_block_read_attributes()
982 s_attr->dev_attr.attr.name = s_attr->name; in mspro_block_read_attributes()
983 s_attr->dev_attr.attr.mode = S_IRUGO; in mspro_block_read_attributes()
984 s_attr->dev_attr.show = mspro_block_attr_show(s_attr->id); in mspro_block_read_attributes()
986 if (!s_attr->size) in mspro_block_read_attributes()
989 s_attr->data = kmalloc(s_attr->size, GFP_KERNEL); in mspro_block_read_attributes()
990 if (!s_attr->data) { in mspro_block_read_attributes()
991 rc = -ENOMEM; in mspro_block_read_attributes()
995 if (((addr / msb->page_size) == (attr_offset / msb->page_size)) in mspro_block_read_attributes()
996 && (((addr + s_attr->size - 1) / msb->page_size) in mspro_block_read_attributes()
997 == (attr_offset / msb->page_size))) { in mspro_block_read_attributes()
998 memcpy(s_attr->data, buffer + addr % msb->page_size, in mspro_block_read_attributes()
999 s_attr->size); in mspro_block_read_attributes()
1003 attr_offset = (addr / msb->page_size) * msb->page_size; in mspro_block_read_attributes()
1005 if ((attr_offset + attr_len) < (addr + s_attr->size)) { in mspro_block_read_attributes()
1007 attr_len = (((addr + s_attr->size) / msb->page_size) in mspro_block_read_attributes()
1008 + 1 ) * msb->page_size - attr_offset; in mspro_block_read_attributes()
1011 rc = -ENOMEM; in mspro_block_read_attributes()
1016 sg_init_one(&msb->req_sg[0], buffer, attr_len); in mspro_block_read_attributes()
1017 msb->seg_count = 1; in mspro_block_read_attributes()
1018 msb->current_seg = 0; in mspro_block_read_attributes()
1019 msb->current_page = 0; in mspro_block_read_attributes()
1020 msb->data_dir = READ; in mspro_block_read_attributes()
1021 msb->transfer_cmd = MSPRO_CMD_READ_ATRB; in mspro_block_read_attributes()
1023 dev_dbg(&card->dev, "reading attribute range %x, %x\n", in mspro_block_read_attributes()
1026 msb->setup_transfer(card, attr_offset, attr_len); in mspro_block_read_attributes()
1027 memstick_new_req(card->host); in mspro_block_read_attributes()
1028 wait_for_completion(&card->mrq_complete); in mspro_block_read_attributes()
1029 if (card->current_mrq.error) { in mspro_block_read_attributes()
1030 rc = card->current_mrq.error; in mspro_block_read_attributes()
1034 memcpy(s_attr->data, buffer + addr % msb->page_size, in mspro_block_read_attributes()
1035 s_attr->size); in mspro_block_read_attributes()
1038 rc = 0; in mspro_block_read_attributes()
1043 return rc; in mspro_block_read_attributes()
1049 struct memstick_host *host = card->host; in mspro_block_init_card()
1050 int rc = 0; in mspro_block_init_card() local
1052 msb->system = MEMSTICK_SYS_SERIAL; in mspro_block_init_card()
1053 msb->setup_transfer = h_mspro_block_setup_cmd; in mspro_block_init_card()
1055 card->reg_addr.r_offset = offsetof(struct mspro_register, status); in mspro_block_init_card()
1056 card->reg_addr.r_length = sizeof(struct ms_status_register); in mspro_block_init_card()
1057 card->reg_addr.w_offset = offsetof(struct mspro_register, param); in mspro_block_init_card()
1058 card->reg_addr.w_length = sizeof(struct mspro_param_register); in mspro_block_init_card()
1061 return -EIO; in mspro_block_init_card()
1063 msb->caps = host->caps; in mspro_block_init_card()
1066 rc = mspro_block_wait_for_ced(card); in mspro_block_init_card()
1067 if (rc) in mspro_block_init_card()
1068 return rc; in mspro_block_init_card()
1070 rc = mspro_block_switch_interface(card); in mspro_block_init_card()
1071 if (rc) in mspro_block_init_card()
1072 return rc; in mspro_block_init_card()
1074 dev_dbg(&card->dev, "card activated\n"); in mspro_block_init_card()
1075 if (msb->system != MEMSTICK_SYS_SERIAL) in mspro_block_init_card()
1076 msb->caps |= MEMSTICK_CAP_AUTO_GET_INT; in mspro_block_init_card()
1078 card->next_request = h_mspro_block_req_init; in mspro_block_init_card()
1079 msb->mrq_handler = h_mspro_block_get_ro; in mspro_block_init_card()
1080 memstick_init_req(&card->current_mrq, MS_TPC_READ_REG, NULL, in mspro_block_init_card()
1082 memstick_new_req(card->host); in mspro_block_init_card()
1083 wait_for_completion(&card->mrq_complete); in mspro_block_init_card()
1084 if (card->current_mrq.error) in mspro_block_init_card()
1085 return card->current_mrq.error; in mspro_block_init_card()
1087 dev_dbg(&card->dev, "card r/w status %d\n", msb->read_only ? 0 : 1); in mspro_block_init_card()
1089 msb->page_size = 512; in mspro_block_init_card()
1090 rc = mspro_block_read_attributes(card); in mspro_block_init_card()
1091 if (rc) in mspro_block_init_card()
1092 return rc; in mspro_block_init_card()
1094 dev_dbg(&card->dev, "attributes loaded\n"); in mspro_block_init_card()
1109 int rc, disk_id; in mspro_block_init_disk() local
1112 for (rc = 0; msb->attr_group.attrs[rc]; ++rc) { in mspro_block_init_disk()
1113 s_attr = mspro_from_sysfs_attr(msb->attr_group.attrs[rc]); in mspro_block_init_disk()
1115 if (s_attr->id == MSPRO_BLOCK_ID_DEVINFO) in mspro_block_init_disk()
1116 dev_info = s_attr->data; in mspro_block_init_disk()
1117 else if (s_attr->id == MSPRO_BLOCK_ID_SYSINFO) in mspro_block_init_disk()
1118 sys_info = s_attr->data; in mspro_block_init_disk()
1122 return -ENODEV; in mspro_block_init_disk()
1124 msb->cylinders = be16_to_cpu(dev_info->cylinders); in mspro_block_init_disk()
1125 msb->heads = be16_to_cpu(dev_info->heads); in mspro_block_init_disk()
1126 msb->sectors_per_track = be16_to_cpu(dev_info->sectors_per_track); in mspro_block_init_disk()
1128 msb->page_size = be16_to_cpu(sys_info->unit_size); in mspro_block_init_disk()
1136 rc = blk_mq_alloc_sq_tag_set(&msb->tag_set, &mspro_mq_ops, 2, in mspro_block_init_disk()
1138 if (rc) in mspro_block_init_disk()
1141 msb->disk = blk_mq_alloc_disk(&msb->tag_set, card); in mspro_block_init_disk()
1142 if (IS_ERR(msb->disk)) { in mspro_block_init_disk()
1143 rc = PTR_ERR(msb->disk); in mspro_block_init_disk()
1146 msb->queue = msb->disk->queue; in mspro_block_init_disk()
1148 blk_queue_max_hw_sectors(msb->queue, MSPRO_BLOCK_MAX_PAGES); in mspro_block_init_disk()
1149 blk_queue_max_segments(msb->queue, MSPRO_BLOCK_MAX_SEGS); in mspro_block_init_disk()
1150 blk_queue_max_segment_size(msb->queue, in mspro_block_init_disk()
1151 MSPRO_BLOCK_MAX_PAGES * msb->page_size); in mspro_block_init_disk()
1153 msb->disk->major = major; in mspro_block_init_disk()
1154 msb->disk->first_minor = disk_id << MSPRO_BLOCK_PART_SHIFT; in mspro_block_init_disk()
1155 msb->disk->minors = 1 << MSPRO_BLOCK_PART_SHIFT; in mspro_block_init_disk()
1156 msb->disk->fops = &ms_block_bdops; in mspro_block_init_disk()
1157 msb->disk->private_data = msb; in mspro_block_init_disk()
1159 sprintf(msb->disk->disk_name, "mspblk%d", disk_id); in mspro_block_init_disk()
1161 blk_queue_logical_block_size(msb->queue, msb->page_size); in mspro_block_init_disk()
1163 capacity = be16_to_cpu(sys_info->user_block_count); in mspro_block_init_disk()
1164 capacity *= be16_to_cpu(sys_info->block_size); in mspro_block_init_disk()
1165 capacity *= msb->page_size >> 9; in mspro_block_init_disk()
1166 set_capacity(msb->disk, capacity); in mspro_block_init_disk()
1167 dev_dbg(&card->dev, "capacity set %ld\n", capacity); in mspro_block_init_disk()
1169 if (msb->read_only) in mspro_block_init_disk()
1170 set_disk_ro(msb->disk, true); in mspro_block_init_disk()
1172 rc = device_add_disk(&card->dev, msb->disk, NULL); in mspro_block_init_disk()
1173 if (rc) in mspro_block_init_disk()
1175 msb->active = 1; in mspro_block_init_disk()
1179 put_disk(msb->disk); in mspro_block_init_disk()
1181 blk_mq_free_tag_set(&msb->tag_set); in mspro_block_init_disk()
1186 return rc; in mspro_block_init_disk()
1194 if (msb->attr_group.attrs) { in mspro_block_data_clear()
1195 for (cnt = 0; msb->attr_group.attrs[cnt]; ++cnt) { in mspro_block_data_clear()
1196 s_attr = mspro_from_sysfs_attr(msb->attr_group in mspro_block_data_clear()
1198 kfree(s_attr->data); in mspro_block_data_clear()
1201 kfree(msb->attr_group.attrs); in mspro_block_data_clear()
1204 msb->card = NULL; in mspro_block_data_clear()
1211 return (msb->active == 1); in mspro_block_check_card()
1217 int rc = 0; in mspro_block_probe() local
1221 return -ENOMEM; in mspro_block_probe()
1223 msb->card = card; in mspro_block_probe()
1224 spin_lock_init(&msb->q_lock); in mspro_block_probe()
1226 rc = mspro_block_init_card(card); in mspro_block_probe()
1228 if (rc) in mspro_block_probe()
1231 rc = sysfs_create_group(&card->dev.kobj, &msb->attr_group); in mspro_block_probe()
1232 if (rc) in mspro_block_probe()
1235 rc = mspro_block_init_disk(card); in mspro_block_probe()
1236 if (!rc) { in mspro_block_probe()
1237 card->check = mspro_block_check_card; in mspro_block_probe()
1238 card->stop = mspro_block_stop; in mspro_block_probe()
1239 card->start = mspro_block_start; in mspro_block_probe()
1243 sysfs_remove_group(&card->dev.kobj, &msb->attr_group); in mspro_block_probe()
1248 return rc; in mspro_block_probe()
1256 spin_lock_irqsave(&msb->q_lock, flags); in mspro_block_remove()
1257 msb->eject = 1; in mspro_block_remove()
1258 spin_unlock_irqrestore(&msb->q_lock, flags); in mspro_block_remove()
1259 blk_mq_start_hw_queues(msb->queue); in mspro_block_remove()
1261 del_gendisk(msb->disk); in mspro_block_remove()
1262 dev_dbg(&card->dev, "mspro block remove\n"); in mspro_block_remove()
1264 blk_mq_free_tag_set(&msb->tag_set); in mspro_block_remove()
1265 msb->queue = NULL; in mspro_block_remove()
1267 sysfs_remove_group(&card->dev.kobj, &msb->attr_group); in mspro_block_remove()
1273 put_disk(msb->disk); in mspro_block_remove()
1284 blk_mq_stop_hw_queues(msb->queue); in mspro_block_suspend()
1286 spin_lock_irqsave(&msb->q_lock, flags); in mspro_block_suspend()
1287 msb->active = 0; in mspro_block_suspend()
1288 spin_unlock_irqrestore(&msb->q_lock, flags); in mspro_block_suspend()
1296 int rc = 0; in mspro_block_resume() local
1301 struct memstick_host *host = card->host; in mspro_block_resume()
1305 mutex_lock(&host->lock); in mspro_block_resume()
1308 rc = -ENOMEM; in mspro_block_resume()
1312 new_msb->card = card; in mspro_block_resume()
1314 rc = mspro_block_init_card(card); in mspro_block_resume()
1315 if (rc) in mspro_block_resume()
1318 for (cnt = 0; new_msb->attr_group.attrs[cnt] in mspro_block_resume()
1319 && msb->attr_group.attrs[cnt]; ++cnt) { in mspro_block_resume()
1320 s_attr = mspro_from_sysfs_attr(new_msb->attr_group.attrs[cnt]); in mspro_block_resume()
1321 r_attr = mspro_from_sysfs_attr(msb->attr_group.attrs[cnt]); in mspro_block_resume()
1323 if (s_attr->id == MSPRO_BLOCK_ID_SYSINFO in mspro_block_resume()
1324 && r_attr->id == s_attr->id) { in mspro_block_resume()
1325 if (memcmp(s_attr->data, r_attr->data, s_attr->size)) in mspro_block_resume()
1328 msb->active = 1; in mspro_block_resume()
1338 mutex_unlock(&host->lock); in mspro_block_resume()
1342 blk_mq_start_hw_queues(msb->queue); in mspro_block_resume()
1343 return rc; in mspro_block_resume()
1374 int rc = -ENOMEM; in mspro_block_init() local
1376 rc = register_blkdev(major, DRIVER_NAME); in mspro_block_init()
1377 if (rc < 0) { in mspro_block_init()
1379 "major %d, error %d\n", major, rc); in mspro_block_init()
1380 return rc; in mspro_block_init()
1383 major = rc; in mspro_block_init()
1385 rc = memstick_register_driver(&mspro_block_driver); in mspro_block_init()
1386 if (rc) in mspro_block_init()
1388 return rc; in mspro_block_init()