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, msb->req_sg); in mspro_block_issue_req()
632 if (!msb->seg_count) { in mspro_block_issue_req()
633 unsigned int bytes = blk_rq_cur_bytes(msb->block_req); in mspro_block_issue_req()
636 chunk = blk_update_request(msb->block_req, in mspro_block_issue_req()
641 __blk_mq_end_request(msb->block_req, in mspro_block_issue_req()
643 msb->block_req = NULL; in mspro_block_issue_req()
644 return -EAGAIN; in mspro_block_issue_req()
647 t_off = blk_rq_pos(msb->block_req); in mspro_block_issue_req()
649 count = blk_rq_bytes(msb->block_req); in mspro_block_issue_req()
651 msb->setup_transfer(card, t_off, count); in mspro_block_issue_req()
653 msb->data_dir = rq_data_dir(msb->block_req); in mspro_block_issue_req()
654 msb->transfer_cmd = msb->data_dir == READ in mspro_block_issue_req()
658 memstick_new_req(card->host); in mspro_block_issue_req()
671 spin_lock_irqsave(&msb->q_lock, flags); in mspro_block_complete_req()
672 dev_dbg(&card->dev, "complete %d, %d\n", msb->block_req ? 1 : 0, in mspro_block_complete_req()
675 if (msb->block_req) { in mspro_block_complete_req()
676 /* Nothing to do - not really an error */ in mspro_block_complete_req()
677 if (error == -EAGAIN) in mspro_block_complete_req()
680 if (error || (card->current_mrq.tpc == MSPRO_CMD_STOP)) { in mspro_block_complete_req()
681 if (msb->data_dir == READ) { in mspro_block_complete_req()
682 for (cnt = 0; cnt < msb->current_seg; cnt++) { in mspro_block_complete_req()
683 t_len += msb->req_sg[cnt].length in mspro_block_complete_req()
684 / msb->page_size; in mspro_block_complete_req()
686 if (msb->current_page) in mspro_block_complete_req()
687 t_len += msb->current_page - 1; in mspro_block_complete_req()
689 t_len *= msb->page_size; in mspro_block_complete_req()
693 t_len = blk_rq_bytes(msb->block_req); in mspro_block_complete_req()
695 dev_dbg(&card->dev, "transferred %x (%d)\n", t_len, error); in mspro_block_complete_req()
698 t_len = blk_rq_cur_bytes(msb->block_req); in mspro_block_complete_req()
700 chunk = blk_update_request(msb->block_req, in mspro_block_complete_req()
707 __blk_mq_end_request(msb->block_req, in mspro_block_complete_req()
709 msb->block_req = NULL; in mspro_block_complete_req()
713 error = -EAGAIN; in mspro_block_complete_req()
716 card->next_request = h_mspro_block_default_bad; in mspro_block_complete_req()
717 complete_all(&card->mrq_complete); in mspro_block_complete_req()
719 spin_unlock_irqrestore(&msb->q_lock, flags); in mspro_block_complete_req()
726 int rc = 0; in mspro_block_stop() local
730 spin_lock_irqsave(&msb->q_lock, flags); in mspro_block_stop()
731 if (!msb->block_req) { in mspro_block_stop()
732 blk_mq_stop_hw_queues(msb->queue); in mspro_block_stop()
733 rc = 1; in mspro_block_stop()
735 spin_unlock_irqrestore(&msb->q_lock, flags); in mspro_block_stop()
737 if (rc) in mspro_block_stop()
740 wait_for_completion(&card->mrq_complete); in mspro_block_stop()
748 blk_mq_start_hw_queues(msb->queue); in mspro_block_start()
754 struct memstick_dev *card = hctx->queue->queuedata; in mspro_queue_rq()
757 spin_lock_irq(&msb->q_lock); in mspro_queue_rq()
759 if (msb->block_req) { in mspro_queue_rq()
760 spin_unlock_irq(&msb->q_lock); in mspro_queue_rq()
764 if (msb->eject) { in mspro_queue_rq()
765 spin_unlock_irq(&msb->q_lock); in mspro_queue_rq()
766 blk_mq_start_request(bd->rq); in mspro_queue_rq()
770 msb->block_req = bd->rq; in mspro_queue_rq()
771 blk_mq_start_request(bd->rq); in mspro_queue_rq()
774 msb->block_req = NULL; in mspro_queue_rq()
776 spin_unlock_irq(&msb->q_lock); in mspro_queue_rq()
786 card->next_request = h_mspro_block_req_init; in mspro_block_wait_for_ced()
787 msb->mrq_handler = h_mspro_block_wait_for_ced; in mspro_block_wait_for_ced()
788 memstick_init_req(&card->current_mrq, MS_TPC_GET_INT, NULL, 1); in mspro_block_wait_for_ced()
789 memstick_new_req(card->host); in mspro_block_wait_for_ced()
790 wait_for_completion(&card->mrq_complete); in mspro_block_wait_for_ced()
791 return card->current_mrq.error; in mspro_block_wait_for_ced()
797 struct memstick_host *host = card->host; in mspro_block_set_interface()
806 card->next_request = h_mspro_block_req_init; in mspro_block_set_interface()
807 msb->mrq_handler = h_mspro_block_default; in mspro_block_set_interface()
808 memstick_init_req(&card->current_mrq, MS_TPC_WRITE_REG, ¶m, in mspro_block_set_interface()
811 wait_for_completion(&card->mrq_complete); in mspro_block_set_interface()
812 return card->current_mrq.error; in mspro_block_set_interface()
817 struct memstick_host *host = card->host; in mspro_block_switch_interface()
819 int rc = 0; in mspro_block_switch_interface() local
822 if (msb->caps & MEMSTICK_CAP_PAR4) in mspro_block_switch_interface()
823 rc = mspro_block_set_interface(card, MEMSTICK_SYS_PAR4); in mspro_block_switch_interface()
827 if (rc) { in mspro_block_switch_interface()
829 "%s: could not switch to 4-bit mode, error %d\n", in mspro_block_switch_interface()
830 dev_name(&card->dev), rc); in mspro_block_switch_interface()
834 msb->system = MEMSTICK_SYS_PAR4; in mspro_block_switch_interface()
835 host->set_param(host, MEMSTICK_INTERFACE, MEMSTICK_PAR4); in mspro_block_switch_interface()
836 printk(KERN_INFO "%s: switching to 4-bit parallel mode\n", in mspro_block_switch_interface()
837 dev_name(&card->dev)); in mspro_block_switch_interface()
839 if (msb->caps & MEMSTICK_CAP_PAR8) { in mspro_block_switch_interface()
840 rc = mspro_block_set_interface(card, MEMSTICK_SYS_PAR8); in mspro_block_switch_interface()
842 if (!rc) { in mspro_block_switch_interface()
843 msb->system = MEMSTICK_SYS_PAR8; in mspro_block_switch_interface()
844 host->set_param(host, MEMSTICK_INTERFACE, in mspro_block_switch_interface()
847 "%s: switching to 8-bit parallel mode\n", in mspro_block_switch_interface()
848 dev_name(&card->dev)); in mspro_block_switch_interface()
851 "%s: could not switch to 8-bit mode, error %d\n", in mspro_block_switch_interface()
852 dev_name(&card->dev), rc); in mspro_block_switch_interface()
855 card->next_request = h_mspro_block_req_init; in mspro_block_switch_interface()
856 msb->mrq_handler = h_mspro_block_default; in mspro_block_switch_interface()
857 memstick_init_req(&card->current_mrq, MS_TPC_GET_INT, NULL, 1); in mspro_block_switch_interface()
858 memstick_new_req(card->host); in mspro_block_switch_interface()
859 wait_for_completion(&card->mrq_complete); in mspro_block_switch_interface()
860 rc = card->current_mrq.error; in mspro_block_switch_interface()
862 if (rc) { in mspro_block_switch_interface()
865 dev_name(&card->dev)); in mspro_block_switch_interface()
866 msb->system = MEMSTICK_SYS_SERIAL; in mspro_block_switch_interface()
867 host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_OFF); in mspro_block_switch_interface()
869 host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_ON); in mspro_block_switch_interface()
870 host->set_param(host, MEMSTICK_INTERFACE, MEMSTICK_SERIAL); in mspro_block_switch_interface()
872 rc = memstick_set_rw_addr(card); in mspro_block_switch_interface()
873 if (!rc) in mspro_block_switch_interface()
874 rc = mspro_block_set_interface(card, msb->system); in mspro_block_switch_interface()
876 if (!rc) { in mspro_block_switch_interface()
878 rc = mspro_block_wait_for_ced(card); in mspro_block_switch_interface()
879 if (rc) in mspro_block_switch_interface()
880 return rc; in mspro_block_switch_interface()
882 if (msb->caps & MEMSTICK_CAP_PAR8) { in mspro_block_switch_interface()
883 msb->caps &= ~MEMSTICK_CAP_PAR8; in mspro_block_switch_interface()
888 return rc; in mspro_block_switch_interface()
901 int cnt, rc, attr_count; in mspro_block_read_attributes() local
907 unsigned int addr, attr_offset = 0, attr_len = msb->page_size; in mspro_block_read_attributes()
909 attr = kmalloc(msb->page_size, GFP_KERNEL); in mspro_block_read_attributes()
911 return -ENOMEM; in mspro_block_read_attributes()
913 sg_init_one(&msb->req_sg[0], attr, msb->page_size); in mspro_block_read_attributes()
914 msb->seg_count = 1; in mspro_block_read_attributes()
915 msb->current_seg = 0; in mspro_block_read_attributes()
916 msb->current_page = 0; in mspro_block_read_attributes()
917 msb->data_dir = READ; in mspro_block_read_attributes()
918 msb->transfer_cmd = MSPRO_CMD_READ_ATRB; in mspro_block_read_attributes()
920 msb->setup_transfer(card, attr_offset, attr_len); in mspro_block_read_attributes()
922 memstick_new_req(card->host); in mspro_block_read_attributes()
923 wait_for_completion(&card->mrq_complete); in mspro_block_read_attributes()
924 if (card->current_mrq.error) { in mspro_block_read_attributes()
925 rc = card->current_mrq.error; in mspro_block_read_attributes()
929 if (be16_to_cpu(attr->signature) != MSPRO_BLOCK_SIGNATURE) { in mspro_block_read_attributes()
930 printk(KERN_ERR "%s: unrecognized device signature %x\n", in mspro_block_read_attributes()
931 dev_name(&card->dev), be16_to_cpu(attr->signature)); in mspro_block_read_attributes()
932 rc = -ENODEV; in mspro_block_read_attributes()
936 if (attr->count > MSPRO_BLOCK_MAX_ATTRIBUTES) { in mspro_block_read_attributes()
938 dev_name(&card->dev)); in mspro_block_read_attributes()
941 attr_count = attr->count; in mspro_block_read_attributes()
943 msb->attr_group.attrs = kcalloc(attr_count + 1, in mspro_block_read_attributes()
944 sizeof(*msb->attr_group.attrs), in mspro_block_read_attributes()
946 if (!msb->attr_group.attrs) { in mspro_block_read_attributes()
947 rc = -ENOMEM; in mspro_block_read_attributes()
950 msb->attr_group.name = "media_attributes"; in mspro_block_read_attributes()
954 rc = -ENOMEM; in mspro_block_read_attributes()
961 rc = -ENOMEM; in mspro_block_read_attributes()
965 msb->attr_group.attrs[cnt] = &s_attr->dev_attr.attr; in mspro_block_read_attributes()
966 addr = be32_to_cpu(attr->entries[cnt].address); in mspro_block_read_attributes()
967 s_attr->size = be32_to_cpu(attr->entries[cnt].size); in mspro_block_read_attributes()
968 dev_dbg(&card->dev, "adding attribute %d: id %x, address %x, " in mspro_block_read_attributes()
969 "size %zx\n", cnt, attr->entries[cnt].id, addr, in mspro_block_read_attributes()
970 s_attr->size); in mspro_block_read_attributes()
971 s_attr->id = attr->entries[cnt].id; in mspro_block_read_attributes()
972 if (mspro_block_attr_name(s_attr->id)) in mspro_block_read_attributes()
973 snprintf(s_attr->name, sizeof(s_attr->name), "%s", in mspro_block_read_attributes()
974 mspro_block_attr_name(attr->entries[cnt].id)); in mspro_block_read_attributes()
976 snprintf(s_attr->name, sizeof(s_attr->name), in mspro_block_read_attributes()
977 "attr_x%02x", attr->entries[cnt].id); in mspro_block_read_attributes()
979 sysfs_attr_init(&s_attr->dev_attr.attr); in mspro_block_read_attributes()
980 s_attr->dev_attr.attr.name = s_attr->name; in mspro_block_read_attributes()
981 s_attr->dev_attr.attr.mode = S_IRUGO; in mspro_block_read_attributes()
982 s_attr->dev_attr.show = mspro_block_attr_show(s_attr->id); in mspro_block_read_attributes()
984 if (!s_attr->size) in mspro_block_read_attributes()
987 s_attr->data = kmalloc(s_attr->size, GFP_KERNEL); in mspro_block_read_attributes()
988 if (!s_attr->data) { in mspro_block_read_attributes()
989 rc = -ENOMEM; in mspro_block_read_attributes()
993 if (((addr / msb->page_size) == (attr_offset / msb->page_size)) in mspro_block_read_attributes()
994 && (((addr + s_attr->size - 1) / msb->page_size) in mspro_block_read_attributes()
995 == (attr_offset / msb->page_size))) { in mspro_block_read_attributes()
996 memcpy(s_attr->data, buffer + addr % msb->page_size, in mspro_block_read_attributes()
997 s_attr->size); in mspro_block_read_attributes()
1001 attr_offset = (addr / msb->page_size) * msb->page_size; in mspro_block_read_attributes()
1003 if ((attr_offset + attr_len) < (addr + s_attr->size)) { in mspro_block_read_attributes()
1005 attr_len = (((addr + s_attr->size) / msb->page_size) in mspro_block_read_attributes()
1006 + 1 ) * msb->page_size - attr_offset; in mspro_block_read_attributes()
1009 rc = -ENOMEM; in mspro_block_read_attributes()
1014 sg_init_one(&msb->req_sg[0], buffer, attr_len); in mspro_block_read_attributes()
1015 msb->seg_count = 1; in mspro_block_read_attributes()
1016 msb->current_seg = 0; in mspro_block_read_attributes()
1017 msb->current_page = 0; in mspro_block_read_attributes()
1018 msb->data_dir = READ; in mspro_block_read_attributes()
1019 msb->transfer_cmd = MSPRO_CMD_READ_ATRB; in mspro_block_read_attributes()
1021 dev_dbg(&card->dev, "reading attribute range %x, %x\n", in mspro_block_read_attributes()
1024 msb->setup_transfer(card, attr_offset, attr_len); in mspro_block_read_attributes()
1025 memstick_new_req(card->host); in mspro_block_read_attributes()
1026 wait_for_completion(&card->mrq_complete); in mspro_block_read_attributes()
1027 if (card->current_mrq.error) { in mspro_block_read_attributes()
1028 rc = card->current_mrq.error; in mspro_block_read_attributes()
1032 memcpy(s_attr->data, buffer + addr % msb->page_size, in mspro_block_read_attributes()
1033 s_attr->size); in mspro_block_read_attributes()
1036 rc = 0; in mspro_block_read_attributes()
1041 return rc; in mspro_block_read_attributes()
1047 struct memstick_host *host = card->host; in mspro_block_init_card()
1048 int rc = 0; in mspro_block_init_card() local
1050 msb->system = MEMSTICK_SYS_SERIAL; in mspro_block_init_card()
1051 msb->setup_transfer = h_mspro_block_setup_cmd; in mspro_block_init_card()
1053 card->reg_addr.r_offset = offsetof(struct mspro_register, status); in mspro_block_init_card()
1054 card->reg_addr.r_length = sizeof(struct ms_status_register); in mspro_block_init_card()
1055 card->reg_addr.w_offset = offsetof(struct mspro_register, param); in mspro_block_init_card()
1056 card->reg_addr.w_length = sizeof(struct mspro_param_register); in mspro_block_init_card()
1059 return -EIO; in mspro_block_init_card()
1061 msb->caps = host->caps; in mspro_block_init_card()
1064 rc = mspro_block_wait_for_ced(card); in mspro_block_init_card()
1065 if (rc) in mspro_block_init_card()
1066 return rc; in mspro_block_init_card()
1068 rc = mspro_block_switch_interface(card); in mspro_block_init_card()
1069 if (rc) in mspro_block_init_card()
1070 return rc; in mspro_block_init_card()
1072 dev_dbg(&card->dev, "card activated\n"); in mspro_block_init_card()
1073 if (msb->system != MEMSTICK_SYS_SERIAL) in mspro_block_init_card()
1074 msb->caps |= MEMSTICK_CAP_AUTO_GET_INT; in mspro_block_init_card()
1076 card->next_request = h_mspro_block_req_init; in mspro_block_init_card()
1077 msb->mrq_handler = h_mspro_block_get_ro; in mspro_block_init_card()
1078 memstick_init_req(&card->current_mrq, MS_TPC_READ_REG, NULL, in mspro_block_init_card()
1080 memstick_new_req(card->host); in mspro_block_init_card()
1081 wait_for_completion(&card->mrq_complete); in mspro_block_init_card()
1082 if (card->current_mrq.error) in mspro_block_init_card()
1083 return card->current_mrq.error; in mspro_block_init_card()
1085 dev_dbg(&card->dev, "card r/w status %d\n", msb->read_only ? 0 : 1); in mspro_block_init_card()
1087 msb->page_size = 512; in mspro_block_init_card()
1088 rc = mspro_block_read_attributes(card); in mspro_block_init_card()
1089 if (rc) in mspro_block_init_card()
1090 return rc; in mspro_block_init_card()
1092 dev_dbg(&card->dev, "attributes loaded\n"); in mspro_block_init_card()
1105 .logical_block_size = msb->page_size, in mspro_block_init_disk()
1108 .max_segment_size = MSPRO_BLOCK_MAX_PAGES * msb->page_size, in mspro_block_init_disk()
1113 int rc, disk_id; in mspro_block_init_disk() local
1116 for (rc = 0; msb->attr_group.attrs[rc]; ++rc) { in mspro_block_init_disk()
1117 s_attr = mspro_from_sysfs_attr(msb->attr_group.attrs[rc]); in mspro_block_init_disk()
1119 if (s_attr->id == MSPRO_BLOCK_ID_DEVINFO) in mspro_block_init_disk()
1120 dev_info = s_attr->data; in mspro_block_init_disk()
1121 else if (s_attr->id == MSPRO_BLOCK_ID_SYSINFO) in mspro_block_init_disk()
1122 sys_info = s_attr->data; in mspro_block_init_disk()
1126 return -ENODEV; in mspro_block_init_disk()
1128 msb->cylinders = be16_to_cpu(dev_info->cylinders); in mspro_block_init_disk()
1129 msb->heads = be16_to_cpu(dev_info->heads); in mspro_block_init_disk()
1130 msb->sectors_per_track = be16_to_cpu(dev_info->sectors_per_track); in mspro_block_init_disk()
1132 msb->page_size = be16_to_cpu(sys_info->unit_size); in mspro_block_init_disk()
1140 rc = blk_mq_alloc_sq_tag_set(&msb->tag_set, &mspro_mq_ops, 2, 0); in mspro_block_init_disk()
1141 if (rc) in mspro_block_init_disk()
1144 msb->disk = blk_mq_alloc_disk(&msb->tag_set, &lim, card); in mspro_block_init_disk()
1145 if (IS_ERR(msb->disk)) { in mspro_block_init_disk()
1146 rc = PTR_ERR(msb->disk); in mspro_block_init_disk()
1149 msb->queue = msb->disk->queue; in mspro_block_init_disk()
1151 msb->disk->major = major; in mspro_block_init_disk()
1152 msb->disk->first_minor = disk_id << MSPRO_BLOCK_PART_SHIFT; in mspro_block_init_disk()
1153 msb->disk->minors = 1 << MSPRO_BLOCK_PART_SHIFT; in mspro_block_init_disk()
1154 msb->disk->fops = &ms_block_bdops; in mspro_block_init_disk()
1155 msb->disk->private_data = msb; in mspro_block_init_disk()
1157 sprintf(msb->disk->disk_name, "mspblk%d", disk_id); in mspro_block_init_disk()
1159 capacity = be16_to_cpu(sys_info->user_block_count); in mspro_block_init_disk()
1160 capacity *= be16_to_cpu(sys_info->block_size); in mspro_block_init_disk()
1161 capacity *= msb->page_size >> 9; in mspro_block_init_disk()
1162 set_capacity(msb->disk, capacity); in mspro_block_init_disk()
1163 dev_dbg(&card->dev, "capacity set %ld\n", capacity); in mspro_block_init_disk()
1165 if (msb->read_only) in mspro_block_init_disk()
1166 set_disk_ro(msb->disk, true); in mspro_block_init_disk()
1168 rc = device_add_disk(&card->dev, msb->disk, NULL); in mspro_block_init_disk()
1169 if (rc) in mspro_block_init_disk()
1171 msb->active = 1; in mspro_block_init_disk()
1175 put_disk(msb->disk); in mspro_block_init_disk()
1177 blk_mq_free_tag_set(&msb->tag_set); in mspro_block_init_disk()
1182 return rc; in mspro_block_init_disk()
1190 if (msb->attr_group.attrs) { in mspro_block_data_clear()
1191 for (cnt = 0; msb->attr_group.attrs[cnt]; ++cnt) { in mspro_block_data_clear()
1192 s_attr = mspro_from_sysfs_attr(msb->attr_group in mspro_block_data_clear()
1194 kfree(s_attr->data); in mspro_block_data_clear()
1197 kfree(msb->attr_group.attrs); in mspro_block_data_clear()
1200 msb->card = NULL; in mspro_block_data_clear()
1207 return (msb->active == 1); in mspro_block_check_card()
1213 int rc = 0; in mspro_block_probe() local
1217 return -ENOMEM; in mspro_block_probe()
1219 msb->card = card; in mspro_block_probe()
1220 spin_lock_init(&msb->q_lock); in mspro_block_probe()
1222 rc = mspro_block_init_card(card); in mspro_block_probe()
1224 if (rc) in mspro_block_probe()
1227 rc = sysfs_create_group(&card->dev.kobj, &msb->attr_group); in mspro_block_probe()
1228 if (rc) in mspro_block_probe()
1231 rc = mspro_block_init_disk(card); in mspro_block_probe()
1232 if (!rc) { in mspro_block_probe()
1233 card->check = mspro_block_check_card; in mspro_block_probe()
1234 card->stop = mspro_block_stop; in mspro_block_probe()
1235 card->start = mspro_block_start; in mspro_block_probe()
1239 sysfs_remove_group(&card->dev.kobj, &msb->attr_group); in mspro_block_probe()
1244 return rc; in mspro_block_probe()
1252 spin_lock_irqsave(&msb->q_lock, flags); in mspro_block_remove()
1253 msb->eject = 1; in mspro_block_remove()
1254 spin_unlock_irqrestore(&msb->q_lock, flags); in mspro_block_remove()
1255 blk_mq_start_hw_queues(msb->queue); in mspro_block_remove()
1257 del_gendisk(msb->disk); in mspro_block_remove()
1258 dev_dbg(&card->dev, "mspro block remove\n"); in mspro_block_remove()
1260 blk_mq_free_tag_set(&msb->tag_set); in mspro_block_remove()
1261 msb->queue = NULL; in mspro_block_remove()
1263 sysfs_remove_group(&card->dev.kobj, &msb->attr_group); in mspro_block_remove()
1269 put_disk(msb->disk); in mspro_block_remove()
1280 blk_mq_stop_hw_queues(msb->queue); in mspro_block_suspend()
1282 spin_lock_irqsave(&msb->q_lock, flags); in mspro_block_suspend()
1283 msb->active = 0; in mspro_block_suspend()
1284 spin_unlock_irqrestore(&msb->q_lock, flags); in mspro_block_suspend()
1292 int rc = 0; in mspro_block_resume() local
1297 struct memstick_host *host = card->host; in mspro_block_resume()
1301 mutex_lock(&host->lock); in mspro_block_resume()
1304 rc = -ENOMEM; in mspro_block_resume()
1308 new_msb->card = card; in mspro_block_resume()
1310 rc = mspro_block_init_card(card); in mspro_block_resume()
1311 if (rc) in mspro_block_resume()
1314 for (cnt = 0; new_msb->attr_group.attrs[cnt] in mspro_block_resume()
1315 && msb->attr_group.attrs[cnt]; ++cnt) { in mspro_block_resume()
1316 s_attr = mspro_from_sysfs_attr(new_msb->attr_group.attrs[cnt]); in mspro_block_resume()
1317 r_attr = mspro_from_sysfs_attr(msb->attr_group.attrs[cnt]); in mspro_block_resume()
1319 if (s_attr->id == MSPRO_BLOCK_ID_SYSINFO in mspro_block_resume()
1320 && r_attr->id == s_attr->id) { in mspro_block_resume()
1321 if (memcmp(s_attr->data, r_attr->data, s_attr->size)) in mspro_block_resume()
1324 msb->active = 1; in mspro_block_resume()
1334 mutex_unlock(&host->lock); in mspro_block_resume()
1338 blk_mq_start_hw_queues(msb->queue); in mspro_block_resume()
1339 return rc; in mspro_block_resume()
1370 int rc = -ENOMEM; in mspro_block_init() local
1372 rc = register_blkdev(major, DRIVER_NAME); in mspro_block_init()
1373 if (rc < 0) { in mspro_block_init()
1375 "major %d, error %d\n", major, rc); in mspro_block_init()
1376 return rc; in mspro_block_init()
1379 major = rc; in mspro_block_init()
1381 rc = memstick_register_driver(&mspro_block_driver); in mspro_block_init()
1382 if (rc) in mspro_block_init()
1384 return rc; in mspro_block_init()