Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2)  * Broadcom 43xx PCMCIA-SSB bridge module
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Copyright (c) 2007 Michael Buesch <m@bues.ch>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * Licensed under the GNU/GPL. See COPYING for details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include "ssb_private.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/ssb/ssb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <pcmcia/cistpl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <pcmcia/ciscode.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <pcmcia/ds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <pcmcia/cisreg.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) static const struct pcmcia_device_id ssb_host_pcmcia_tbl[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 	PCMCIA_DEVICE_MANF_CARD(0x2D0, 0x448),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 	PCMCIA_DEVICE_MANF_CARD(0x2D0, 0x476),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 	PCMCIA_DEVICE_NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) MODULE_DEVICE_TABLE(pcmcia, ssb_host_pcmcia_tbl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) static int ssb_host_pcmcia_probe(struct pcmcia_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	struct ssb_bus *ssb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	int err = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 	int res = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	ssb = kzalloc(sizeof(*ssb), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	if (!ssb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 		goto out_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	dev->config_flags |= CONF_ENABLE_IRQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	dev->resource[2]->flags |=  WIN_ENABLE | WIN_DATA_WIDTH_16 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 			 WIN_USE_WAIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	dev->resource[2]->start = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	dev->resource[2]->end = SSB_CORE_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	res = pcmcia_request_window(dev, dev->resource[2], 250);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	if (res != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 		goto err_kfree_ssb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	res = pcmcia_map_mem_page(dev, dev->resource[2], 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	if (res != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 		goto err_disable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	if (!dev->irq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 		goto err_disable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	res = pcmcia_enable_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	if (res != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 		goto err_disable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	err = ssb_bus_pcmciabus_register(ssb, dev, dev->resource[2]->start);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 		goto err_disable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	dev->priv = ssb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) err_disable:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	pcmcia_disable_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) err_kfree_ssb:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	kfree(ssb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) out_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	dev_err(&dev->dev, "Initialization failed (%d, %d)\n", res, err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) static void ssb_host_pcmcia_remove(struct pcmcia_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	struct ssb_bus *ssb = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	ssb_bus_unregister(ssb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	pcmcia_disable_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	kfree(ssb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	dev->priv = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) #ifdef CONFIG_PM
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) static int ssb_host_pcmcia_suspend(struct pcmcia_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	struct ssb_bus *ssb = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	return ssb_bus_suspend(ssb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) static int ssb_host_pcmcia_resume(struct pcmcia_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	struct ssb_bus *ssb = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	return ssb_bus_resume(ssb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) #else /* CONFIG_PM */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) # define ssb_host_pcmcia_suspend		NULL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) # define ssb_host_pcmcia_resume		NULL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) #endif /* CONFIG_PM */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) static struct pcmcia_driver ssb_host_pcmcia_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	.owner		= THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	.name		= "ssb-pcmcia",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	.id_table	= ssb_host_pcmcia_tbl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	.probe		= ssb_host_pcmcia_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	.remove		= ssb_host_pcmcia_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	.suspend	= ssb_host_pcmcia_suspend,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	.resume		= ssb_host_pcmcia_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static int pcmcia_init_failed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)  * These are not module init/exit functions!
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)  * The module_pcmcia_driver() helper cannot be used here.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) int ssb_host_pcmcia_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	pcmcia_init_failed = pcmcia_register_driver(&ssb_host_pcmcia_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	return pcmcia_init_failed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) void ssb_host_pcmcia_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	if (!pcmcia_init_failed)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 		pcmcia_unregister_driver(&ssb_host_pcmcia_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) }