1 // SPDX-License-Identifier: GPL-2.0-only
29 			      const struct memstick_device_id *id)  in memstick_dev_match()  argument
31 	if (id->match_flags & MEMSTICK_MATCH_ALL) {  in memstick_dev_match()
32 		if ((id->type == card->id.type)  in memstick_dev_match()
33 		    && (id->category == card->id.category)  in memstick_dev_match()
34 		    && (id->class == card->id.class))  in memstick_dev_match()
47 	const struct memstick_device_id *ids = ms_drv->id_table;  in memstick_bus_match()
50 		while (ids->match_flags) {  in memstick_bus_match()
64 	if (add_uevent_var(env, "MEMSTICK_TYPE=%02X", card->id.type))  in memstick_uevent()
65 		return -ENOMEM;  in memstick_uevent()
67 	if (add_uevent_var(env, "MEMSTICK_CATEGORY=%02X", card->id.category))  in memstick_uevent()
68 		return -ENOMEM;  in memstick_uevent()
70 	if (add_uevent_var(env, "MEMSTICK_CLASS=%02X", card->id.class))  in memstick_uevent()
71 		return -ENOMEM;  in memstick_uevent()
80 	struct memstick_driver *drv = container_of(dev->driver,  in memstick_device_probe()
83 	int rc = -ENODEV;  in memstick_device_probe()
85 	if (dev->driver && drv->probe) {  in memstick_device_probe()
86 		rc = drv->probe(card);  in memstick_device_probe()
97 	struct memstick_driver *drv = container_of(dev->driver,  in memstick_device_remove()
101 	if (dev->driver && drv->remove) {  in memstick_device_remove()
102 		drv->remove(card);  in memstick_device_remove()
103 		card->dev.driver = NULL;  in memstick_device_remove()
115 	struct memstick_driver *drv = container_of(dev->driver,  in memstick_device_suspend()
119 	if (dev->driver && drv->suspend)  in memstick_device_suspend()
120 		return drv->suspend(card, state);  in memstick_device_suspend()
128 	struct memstick_driver *drv = container_of(dev->driver,  in memstick_device_resume()
132 	if (dev->driver && drv->resume)  in memstick_device_resume()
133 		return drv->resume(card);  in memstick_device_resume()
150 	return sprintf(buf, format, card->id.name);                           \
179 	struct memstick_host *host = container_of(dev, struct memstick_host,  in memstick_free()  local
181 	kfree(host);  in memstick_free()
202  * memstick_detect_change - schedule media detection on memstick host
203  * @host: host to use
205 void memstick_detect_change(struct memstick_host *host)  in memstick_detect_change()  argument
207 	queue_work(workqueue, &host->media_checker);  in memstick_detect_change()
212  * memstick_next_req - called by host driver to obtain next request to process
213  * @host: host to use
216  * Host calls this function from idle state (*mrq == NULL) or after finishing
220  * Returns: value of 0 means that new request was assigned to the host.
223 int memstick_next_req(struct memstick_host *host, struct memstick_request **mrq)  in memstick_next_req()  argument
225 	int rc = -ENXIO;  in memstick_next_req()
227 	if ((*mrq) && (*mrq)->error && host->retries) {  in memstick_next_req()
228 		(*mrq)->error = rc;  in memstick_next_req()
229 		host->retries--;  in memstick_next_req()
233 	if (host->card && host->card->next_request)  in memstick_next_req()
234 		rc = host->card->next_request(host->card, mrq);  in memstick_next_req()
237 		host->retries = cmd_retries > 1 ? cmd_retries - 1 : 1;  in memstick_next_req()
246  * memstick_new_req - notify the host that some requests are pending
247  * @host: host to use
249 void memstick_new_req(struct memstick_host *host)  in memstick_new_req()  argument
251 	if (host->card) {  in memstick_new_req()
252 		host->retries = cmd_retries;  in memstick_new_req()
253 		reinit_completion(&host->card->mrq_complete);  in memstick_new_req()
254 		host->request(host);  in memstick_new_req()
260  * memstick_init_req_sg - set request fields needed for bulk data transfer
268 	mrq->tpc = tpc;  in memstick_init_req_sg()
270 		mrq->data_dir = WRITE;  in memstick_init_req_sg()
272 		mrq->data_dir = READ;  in memstick_init_req_sg()
274 	mrq->sg = *sg;  in memstick_init_req_sg()
275 	mrq->long_data = 1;  in memstick_init_req_sg()
278 		mrq->need_card_int = 1;  in memstick_init_req_sg()
280 		mrq->need_card_int = 0;  in memstick_init_req_sg()
285  * memstick_init_req - set request fields needed for short data transfer
298 	mrq->tpc = tpc;  in memstick_init_req()
300 		mrq->data_dir = WRITE;  in memstick_init_req()
302 		mrq->data_dir = READ;  in memstick_init_req()
304 	mrq->data_len = length > sizeof(mrq->data) ? sizeof(mrq->data) : length;  in memstick_init_req()
305 	if (mrq->data_dir == WRITE)  in memstick_init_req()
306 		memcpy(mrq->data, buf, mrq->data_len);  in memstick_init_req()
308 	mrq->long_data = 0;  in memstick_init_req()
311 		mrq->need_card_int = 1;  in memstick_init_req()
313 		mrq->need_card_int = 0;  in memstick_init_req()
320  * ongoing, while special error value of -EAGAIN means that current request is
330 		memstick_init_req(&card->current_mrq, MS_TPC_READ_REG, &id_reg,  in h_memstick_read_dev_id()
332 		*mrq = &card->current_mrq;  in h_memstick_read_dev_id()
335 	if (!(*mrq)->error) {  in h_memstick_read_dev_id()
336 		memcpy(&id_reg, (*mrq)->data, sizeof(id_reg));  in h_memstick_read_dev_id()
337 		card->id.match_flags = MEMSTICK_MATCH_ALL;  in h_memstick_read_dev_id()
338 		card->id.type = id_reg.type;  in h_memstick_read_dev_id()
339 		card->id.category = id_reg.category;  in h_memstick_read_dev_id()
340 		card->id.class = id_reg.class;  in h_memstick_read_dev_id()
341 		dev_dbg(&card->dev, "if_mode = %02x\n", id_reg.if_mode);  in h_memstick_read_dev_id()
343 	complete(&card->mrq_complete);  in h_memstick_read_dev_id()
344 	return -EAGAIN;  in h_memstick_read_dev_id()
351 		memstick_init_req(&card->current_mrq, MS_TPC_SET_RW_REG_ADRS,  in h_memstick_set_rw_addr()
352 				  (char *)&card->reg_addr,  in h_memstick_set_rw_addr()
353 				  sizeof(card->reg_addr));  in h_memstick_set_rw_addr()
354 		*mrq = &card->current_mrq;  in h_memstick_set_rw_addr()
357 		complete(&card->mrq_complete);  in h_memstick_set_rw_addr()
358 		return -EAGAIN;  in h_memstick_set_rw_addr()
363  * memstick_set_rw_addr - issue SET_RW_REG_ADDR request and wait for it to
371 	card->next_request = h_memstick_set_rw_addr;  in memstick_set_rw_addr()
372 	memstick_new_req(card->host);  in memstick_set_rw_addr()
373 	wait_for_completion(&card->mrq_complete);  in memstick_set_rw_addr()
375 	return card->current_mrq.error;  in memstick_set_rw_addr()
379 static struct memstick_dev *memstick_alloc_card(struct memstick_host *host)  in memstick_alloc_card()  argument
383 	struct memstick_dev *old_card = host->card;  in memstick_alloc_card()
387 		card->host = host;  in memstick_alloc_card()
388 		dev_set_name(&card->dev, "%s", dev_name(&host->dev));  in memstick_alloc_card()
389 		card->dev.parent = &host->dev;  in memstick_alloc_card()
390 		card->dev.bus = &memstick_bus_type;  in memstick_alloc_card()
391 		card->dev.release = memstick_free_card;  in memstick_alloc_card()
392 		card->check = memstick_dummy_check;  in memstick_alloc_card()
394 		card->reg_addr.r_offset = offsetof(struct ms_register, id);  in memstick_alloc_card()
395 		card->reg_addr.r_length = sizeof(id_reg);  in memstick_alloc_card()
396 		card->reg_addr.w_offset = offsetof(struct ms_register, id);  in memstick_alloc_card()
397 		card->reg_addr.w_length = sizeof(id_reg);  in memstick_alloc_card()
399 		init_completion(&card->mrq_complete);  in memstick_alloc_card()
401 		host->card = card;  in memstick_alloc_card()
405 		card->next_request = h_memstick_read_dev_id;  in memstick_alloc_card()
406 		memstick_new_req(host);  in memstick_alloc_card()
407 		wait_for_completion(&card->mrq_complete);  in memstick_alloc_card()
409 		if (card->current_mrq.error)  in memstick_alloc_card()
412 	host->card = old_card;  in memstick_alloc_card()
415 	host->card = old_card;  in memstick_alloc_card()
416 	kfree_const(card->dev.kobj.name);  in memstick_alloc_card()
421 static int memstick_power_on(struct memstick_host *host)  in memstick_power_on()  argument
423 	int rc = host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_ON);  in memstick_power_on()
426 		rc = host->set_param(host, MEMSTICK_INTERFACE, MEMSTICK_SERIAL);  in memstick_power_on()
433 	struct memstick_host *host = container_of(work, struct memstick_host,  in memstick_check()  local
437 	dev_dbg(&host->dev, "memstick_check started\n");  in memstick_check()
438 	pm_runtime_get_noresume(host->dev.parent);  in memstick_check()
439 	mutex_lock(&host->lock);  in memstick_check()
440 	if (!host->card) {  in memstick_check()
441 		if (memstick_power_on(host))  in memstick_check()
443 	} else if (host->card->stop)  in memstick_check()
444 		host->card->stop(host->card);  in memstick_check()
446 	if (host->removing)  in memstick_check()
449 	card = memstick_alloc_card(host);  in memstick_check()
452 		if (host->card) {  in memstick_check()
453 			device_unregister(&host->card->dev);  in memstick_check()
454 			host->card = NULL;  in memstick_check()
457 		dev_dbg(&host->dev, "new card %02x, %02x, %02x\n",  in memstick_check()
458 			card->id.type, card->id.category, card->id.class);  in memstick_check()
459 		if (host->card) {  in memstick_check()
460 			if (memstick_set_rw_addr(host->card)  in memstick_check()
461 			    || !memstick_dev_match(host->card, &card->id)  in memstick_check()
462 			    || !(host->card->check(host->card))) {  in memstick_check()
463 				device_unregister(&host->card->dev);  in memstick_check()
464 				host->card = NULL;  in memstick_check()
465 			} else if (host->card->start)  in memstick_check()
466 				host->card->start(host->card);  in memstick_check()
469 		if (!host->card) {  in memstick_check()
470 			host->card = card;  in memstick_check()
471 			if (device_register(&card->dev)) {  in memstick_check()
472 				put_device(&card->dev);  in memstick_check()
473 				host->card = NULL;  in memstick_check()
476 			kfree_const(card->dev.kobj.name);  in memstick_check()
482 	if (!host->card)  in memstick_check()
483 		host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_OFF);  in memstick_check()
485 	mutex_unlock(&host->lock);  in memstick_check()
486 	pm_runtime_put(host->dev.parent);  in memstick_check()
487 	dev_dbg(&host->dev, "memstick_check finished\n");  in memstick_check()
491  * memstick_alloc_host - allocate a memstick_host structure
493  * @dev: parent device of the host
500 	struct memstick_host *host;  in memstick_alloc_host()  local
502 	host = kzalloc(sizeof(struct memstick_host) + extra, GFP_KERNEL);  in memstick_alloc_host()
503 	if (host) {  in memstick_alloc_host()
504 		mutex_init(&host->lock);  in memstick_alloc_host()
505 		INIT_WORK(&host->media_checker, memstick_check);  in memstick_alloc_host()
506 		host->dev.class = &memstick_host_class;  in memstick_alloc_host()
507 		host->dev.parent = dev;  in memstick_alloc_host()
508 		device_initialize(&host->dev);  in memstick_alloc_host()
510 	return host;  in memstick_alloc_host()
515  * memstick_add_host - start request processing on memstick host
516  * @host: host to use
520 int memstick_add_host(struct memstick_host *host)  in memstick_add_host()  argument
527 	rc = idr_alloc(&memstick_host_idr, host, 0, 0, GFP_NOWAIT);  in memstick_add_host()
529 		host->id = rc;  in memstick_add_host()
536 	dev_set_name(&host->dev, "memstick%u", host->id);  in memstick_add_host()
538 	rc = device_add(&host->dev);  in memstick_add_host()
541 		idr_remove(&memstick_host_idr, host->id);  in memstick_add_host()
546 	host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_OFF);  in memstick_add_host()
547 	memstick_detect_change(host);  in memstick_add_host()
553  * memstick_remove_host - stop request processing on memstick host
554  * @host: host to use
556 void memstick_remove_host(struct memstick_host *host)  in memstick_remove_host()  argument
558 	host->removing = 1;  in memstick_remove_host()
560 	mutex_lock(&host->lock);  in memstick_remove_host()
561 	if (host->card)  in memstick_remove_host()
562 		device_unregister(&host->card->dev);  in memstick_remove_host()
563 	host->card = NULL;  in memstick_remove_host()
564 	host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_OFF);  in memstick_remove_host()
565 	mutex_unlock(&host->lock);  in memstick_remove_host()
568 	idr_remove(&memstick_host_idr, host->id);  in memstick_remove_host()
570 	device_del(&host->dev);  in memstick_remove_host()
575  * memstick_free_host - free memstick host
576  * @host: host to use
578 void memstick_free_host(struct memstick_host *host)  in memstick_free_host()  argument
580 	mutex_destroy(&host->lock);  in memstick_free_host()
581 	put_device(&host->dev);  in memstick_free_host()
586  * memstick_suspend_host - notify bus driver of host suspension
587  * @host: host to use
589 void memstick_suspend_host(struct memstick_host *host)  in memstick_suspend_host()  argument
591 	mutex_lock(&host->lock);  in memstick_suspend_host()
592 	host->set_param(host, MEMSTICK_POWER, MEMSTICK_POWER_OFF);  in memstick_suspend_host()
593 	mutex_unlock(&host->lock);  in memstick_suspend_host()
598  * memstick_resume_host - notify bus driver of host resumption
599  * @host: host to use
601 void memstick_resume_host(struct memstick_host *host)  in memstick_resume_host()  argument
605 	mutex_lock(&host->lock);  in memstick_resume_host()
606 	if (host->card)  in memstick_resume_host()
607 		rc = memstick_power_on(host);  in memstick_resume_host()
608 	mutex_unlock(&host->lock);  in memstick_resume_host()
611 		memstick_detect_change(host);  in memstick_resume_host()
617 	drv->driver.bus = &memstick_bus_type;  in memstick_register_driver()
619 	return driver_register(&drv->driver);  in memstick_register_driver()
625 	driver_unregister(&drv->driver);  in memstick_unregister_driver()
636 		return -ENOMEM;  in memstick_init()