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)  *	TURBOchannel bus services.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *	Copyright (c) Harald Koerfgen, 1998
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *	Copyright (c) 2001, 2003, 2005, 2006, 2018  Maciej W. Rozycki
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *	Copyright (c) 2005  James Simmons
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  *	This file is subject to the terms and conditions of the GNU
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  *	General Public License.  See the file "COPYING" in the main
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  *	directory of this archive for more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/compiler.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/dma-mapping.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/ioport.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/list.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/tc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) static struct tc_bus tc_bus = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	.name = "TURBOchannel",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32)  * Probing for TURBOchannel modules.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) static void __init tc_bus_add_devices(struct tc_bus *tbus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	resource_size_t slotsize = tbus->info.slot_size << 20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	resource_size_t extslotsize = tbus->ext_slot_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	resource_size_t slotaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	resource_size_t extslotaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	resource_size_t devsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	void __iomem *module;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	struct tc_dev *tdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	int i, slot, err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	u8 pattern[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	long offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	for (slot = 0; slot < tbus->num_tcslots; slot++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 		slotaddr = tbus->slot_base + slot * slotsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 		extslotaddr = tbus->ext_slot_base + slot * extslotsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 		module = ioremap(slotaddr, slotsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 		BUG_ON(!module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 		offset = TC_OLDCARD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 		err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 		err |= tc_preadb(pattern + 0, module + offset + TC_PATTERN0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 		err |= tc_preadb(pattern + 1, module + offset + TC_PATTERN1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 		err |= tc_preadb(pattern + 2, module + offset + TC_PATTERN2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 		err |= tc_preadb(pattern + 3, module + offset + TC_PATTERN3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 		if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 			goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 		if (pattern[0] != 0x55 || pattern[1] != 0x00 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 		    pattern[2] != 0xaa || pattern[3] != 0xff) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 			offset = TC_NEWCARD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 			err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 			err |= tc_preadb(pattern + 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 					 module + offset + TC_PATTERN0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 			err |= tc_preadb(pattern + 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 					 module + offset + TC_PATTERN1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 			err |= tc_preadb(pattern + 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 					 module + offset + TC_PATTERN2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 			err |= tc_preadb(pattern + 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 					 module + offset + TC_PATTERN3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 			if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 				goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 		if (pattern[0] != 0x55 || pattern[1] != 0x00 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		    pattern[2] != 0xaa || pattern[3] != 0xff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 			goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 		/* Found a board, allocate it an entry in the list */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		tdev = kzalloc(sizeof(*tdev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		if (!tdev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 			pr_err("tc%x: unable to allocate tc_dev\n", slot);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 			goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		dev_set_name(&tdev->dev, "tc%x", slot);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 		tdev->bus = tbus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		tdev->dev.parent = &tbus->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		tdev->dev.bus = &tc_bus_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 		tdev->slot = slot;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		/* TURBOchannel has 34-bit DMA addressing (16GiB space). */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 		tdev->dma_mask = DMA_BIT_MASK(34);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 		tdev->dev.dma_mask = &tdev->dma_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		tdev->dev.coherent_dma_mask = DMA_BIT_MASK(34);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 		for (i = 0; i < 8; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 			tdev->firmware[i] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 				readb(module + offset + TC_FIRM_VER + 4 * i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 			tdev->vendor[i] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 				readb(module + offset + TC_VENDOR + 4 * i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 			tdev->name[i] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 				readb(module + offset + TC_MODULE + 4 * i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 		tdev->firmware[8] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 		tdev->vendor[8] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		tdev->name[8] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		pr_info("%s: %s %s %s\n", dev_name(&tdev->dev), tdev->vendor,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 			tdev->name, tdev->firmware);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 		devsize = readb(module + offset + TC_SLOT_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 		devsize <<= 22;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		if (devsize <= slotsize) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 			tdev->resource.start = slotaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 			tdev->resource.end = slotaddr + devsize - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 		} else if (devsize <= extslotsize) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 			tdev->resource.start = extslotaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 			tdev->resource.end = extslotaddr + devsize - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 			pr_err("%s: Cannot provide slot space "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 			       "(%ldMiB required, up to %ldMiB supported)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 			       dev_name(&tdev->dev), (long)(devsize >> 20),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 			       (long)(max(slotsize, extslotsize) >> 20));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 			kfree(tdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 			goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 		tdev->resource.name = tdev->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 		tdev->resource.flags = IORESOURCE_MEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 		tc_device_get_irq(tdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 		if (device_register(&tdev->dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 			put_device(&tdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 			goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 		list_add_tail(&tdev->node, &tbus->devices);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) out_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 		iounmap(module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)  * The main entry.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) static int __init tc_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	/* Initialize the TURBOchannel bus */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	if (tc_bus_get_info(&tc_bus))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 		goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	INIT_LIST_HEAD(&tc_bus.devices);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	dev_set_name(&tc_bus.dev, "tc");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	if (device_register(&tc_bus.dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 		goto out_err_device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	if (tc_bus.info.slot_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		unsigned int tc_clock = tc_get_speed(&tc_bus) / 100000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 		pr_info("tc: TURBOchannel rev. %d at %d.%d MHz "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 			"(with%s parity)\n", tc_bus.info.revision,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 			tc_clock / 10, tc_clock % 10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 			tc_bus.info.parity ? "" : "out");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 		tc_bus.resource[0].start = tc_bus.slot_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 		tc_bus.resource[0].end = tc_bus.slot_base +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 					 (tc_bus.info.slot_size << 20) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 					 tc_bus.num_tcslots - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 		tc_bus.resource[0].name = tc_bus.name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		tc_bus.resource[0].flags = IORESOURCE_MEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 		if (request_resource(&iomem_resource,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 				     &tc_bus.resource[0]) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 			pr_err("tc: Cannot reserve resource\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 			goto out_err_device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		if (tc_bus.ext_slot_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 			tc_bus.resource[1].start = tc_bus.ext_slot_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 			tc_bus.resource[1].end = tc_bus.ext_slot_base +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 						 tc_bus.ext_slot_size *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 						 tc_bus.num_tcslots - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 			tc_bus.resource[1].name = tc_bus.name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 			tc_bus.resource[1].flags = IORESOURCE_MEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 			if (request_resource(&iomem_resource,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 					     &tc_bus.resource[1]) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 				pr_err("tc: Cannot reserve resource\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 				goto out_err_resource;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 		tc_bus_add_devices(&tc_bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) out_err_resource:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	release_resource(&tc_bus.resource[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) out_err_device:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	put_device(&tc_bus.dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) out_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) subsys_initcall(tc_init);