1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * init_ohci1394_dma.c - Initializes physical DMA on all OHCI 1394 controllers 4 * 5 * Copyright (C) 2006-2007 Bernhard Kaindl <bk@suse.de> 6 * 7 * Derived from drivers/ieee1394/ohci1394.c and arch/x86/kernel/early-quirks.c 8 * this file has functions to: 9 * - scan the PCI very early on boot for all OHCI 1394-compliant controllers 10 * - reset and initialize them and make them join the IEEE1394 bus and 11 * - enable physical DMA on them to allow remote debugging 12 * 13 * All code and data is marked as __init and __initdata, respective as 14 * during boot, all OHCI1394 controllers may be claimed by the firewire 15 * stack and at this point, this code should not touch them anymore. 16 * 17 * To use physical DMA after the initialization of the firewire stack, 18 * be sure that the stack enables it and (re-)attach after the bus reset 19 * which may be caused by the firewire stack initialization. 20 */ 21 22 #include <linux/delay.h> 23 #include <linux/io.h> 24 #include <linux/kernel.h> 25 #include <linux/pci.h> /* for PCI defines */ 26 #include <linux/string.h> 27 28 #include <asm/pci-direct.h> /* for direct PCI config space access */ 29 #include <asm/fixmap.h> 30 31 #include <linux/init_ohci1394_dma.h> 32 #include "ohci.h" 33 34 int __initdata init_ohci1394_dma_early; 35 36 struct ohci { 37 void __iomem *registers; 38 }; 39 reg_write(const struct ohci * ohci,int offset,u32 data)40 static inline void reg_write(const struct ohci *ohci, int offset, u32 data) 41 { 42 writel(data, ohci->registers + offset); 43 } 44 reg_read(const struct ohci * ohci,int offset)45 static inline u32 reg_read(const struct ohci *ohci, int offset) 46 { 47 return readl(ohci->registers + offset); 48 } 49 50 #define OHCI_LOOP_COUNT 100 /* Number of loops for reg read waits */ 51 52 /* Reads a PHY register of an OHCI-1394 controller */ get_phy_reg(struct ohci * ohci,u8 addr)53 static inline u8 __init get_phy_reg(struct ohci *ohci, u8 addr) 54 { 55 int i; 56 u32 r; 57 58 reg_write(ohci, OHCI1394_PhyControl, (addr << 8) | 0x00008000); 59 60 for (i = 0; i < OHCI_LOOP_COUNT; i++) { 61 if (reg_read(ohci, OHCI1394_PhyControl) & 0x80000000) 62 break; 63 mdelay(1); 64 } 65 r = reg_read(ohci, OHCI1394_PhyControl); 66 67 return (r & 0x00ff0000) >> 16; 68 } 69 70 /* Writes to a PHY register of an OHCI-1394 controller */ set_phy_reg(struct ohci * ohci,u8 addr,u8 data)71 static inline void __init set_phy_reg(struct ohci *ohci, u8 addr, u8 data) 72 { 73 int i; 74 75 reg_write(ohci, OHCI1394_PhyControl, (addr << 8) | data | 0x00004000); 76 77 for (i = 0; i < OHCI_LOOP_COUNT; i++) { 78 if (!(reg_read(ohci, OHCI1394_PhyControl) & 0x00004000)) 79 break; 80 mdelay(1); 81 } 82 } 83 84 /* Resets an OHCI-1394 controller (for sane state before initialization) */ init_ohci1394_soft_reset(struct ohci * ohci)85 static inline void __init init_ohci1394_soft_reset(struct ohci *ohci) 86 { 87 int i; 88 89 reg_write(ohci, OHCI1394_HCControlSet, OHCI1394_HCControl_softReset); 90 91 for (i = 0; i < OHCI_LOOP_COUNT; i++) { 92 if (!(reg_read(ohci, OHCI1394_HCControlSet) 93 & OHCI1394_HCControl_softReset)) 94 break; 95 mdelay(1); 96 } 97 } 98 99 #define OHCI1394_MAX_AT_REQ_RETRIES 0xf 100 #define OHCI1394_MAX_AT_RESP_RETRIES 0x2 101 #define OHCI1394_MAX_PHYS_RESP_RETRIES 0x8 102 103 /* Basic OHCI-1394 register and port inititalization */ init_ohci1394_initialize(struct ohci * ohci)104 static inline void __init init_ohci1394_initialize(struct ohci *ohci) 105 { 106 u32 bus_options; 107 int num_ports, i; 108 109 /* Put some defaults to these undefined bus options */ 110 bus_options = reg_read(ohci, OHCI1394_BusOptions); 111 bus_options |= 0x60000000; /* Enable CMC and ISC */ 112 bus_options &= ~0x00ff0000; /* XXX: Set cyc_clk_acc to zero for now */ 113 bus_options &= ~0x18000000; /* Disable PMC and BMC */ 114 reg_write(ohci, OHCI1394_BusOptions, bus_options); 115 116 /* Set the bus number */ 117 reg_write(ohci, OHCI1394_NodeID, 0x0000ffc0); 118 119 /* Enable posted writes */ 120 reg_write(ohci, OHCI1394_HCControlSet, 121 OHCI1394_HCControl_postedWriteEnable); 122 123 /* Clear link control register */ 124 reg_write(ohci, OHCI1394_LinkControlClear, 0xffffffff); 125 126 /* enable phys */ 127 reg_write(ohci, OHCI1394_LinkControlSet, 128 OHCI1394_LinkControl_rcvPhyPkt); 129 130 /* Don't accept phy packets into AR request context */ 131 reg_write(ohci, OHCI1394_LinkControlClear, 0x00000400); 132 133 /* Clear the Isochonouys interrupt masks */ 134 reg_write(ohci, OHCI1394_IsoRecvIntMaskClear, 0xffffffff); 135 reg_write(ohci, OHCI1394_IsoRecvIntEventClear, 0xffffffff); 136 reg_write(ohci, OHCI1394_IsoXmitIntMaskClear, 0xffffffff); 137 reg_write(ohci, OHCI1394_IsoXmitIntEventClear, 0xffffffff); 138 139 /* Accept asynchronous transfer requests from all nodes for now */ 140 reg_write(ohci, OHCI1394_AsReqFilterHiSet, 0x80000000); 141 142 /* Specify asynchronous transfer retries */ 143 reg_write(ohci, OHCI1394_ATRetries, 144 OHCI1394_MAX_AT_REQ_RETRIES | 145 (OHCI1394_MAX_AT_RESP_RETRIES<<4) | 146 (OHCI1394_MAX_PHYS_RESP_RETRIES<<8)); 147 148 /* We don't want hardware swapping */ 149 reg_write(ohci, OHCI1394_HCControlClear, 150 OHCI1394_HCControl_noByteSwapData); 151 152 /* Enable link */ 153 reg_write(ohci, OHCI1394_HCControlSet, OHCI1394_HCControl_linkEnable); 154 155 /* If anything is connected to a port, make sure it is enabled */ 156 num_ports = get_phy_reg(ohci, 2) & 0xf; 157 for (i = 0; i < num_ports; i++) { 158 unsigned int status; 159 160 set_phy_reg(ohci, 7, i); 161 status = get_phy_reg(ohci, 8); 162 163 if (status & 0x20) 164 set_phy_reg(ohci, 8, status & ~1); 165 } 166 } 167 168 /** 169 * init_ohci1394_wait_for_busresets - wait until bus resets are completed 170 * 171 * OHCI1394 initialization itself and any device going on- or offline 172 * and any cable issue cause a IEEE1394 bus reset. The OHCI1394 spec 173 * specifies that physical DMA is disabled on each bus reset and it 174 * has to be enabled after each bus reset when needed. We resort 175 * to polling here because on early boot, we have no interrupts. 176 */ init_ohci1394_wait_for_busresets(struct ohci * ohci)177 static inline void __init init_ohci1394_wait_for_busresets(struct ohci *ohci) 178 { 179 int i, events; 180 181 for (i = 0; i < 9; i++) { 182 mdelay(200); 183 events = reg_read(ohci, OHCI1394_IntEventSet); 184 if (events & OHCI1394_busReset) 185 reg_write(ohci, OHCI1394_IntEventClear, 186 OHCI1394_busReset); 187 } 188 } 189 190 /** 191 * init_ohci1394_enable_physical_dma - Enable physical DMA for remote debugging 192 * This enables remote DMA access over IEEE1394 from every host for the low 193 * 4GB of address space. DMA accesses above 4GB are not available currently. 194 */ init_ohci1394_enable_physical_dma(struct ohci * ohci)195 static inline void __init init_ohci1394_enable_physical_dma(struct ohci *ohci) 196 { 197 reg_write(ohci, OHCI1394_PhyReqFilterHiSet, 0xffffffff); 198 reg_write(ohci, OHCI1394_PhyReqFilterLoSet, 0xffffffff); 199 reg_write(ohci, OHCI1394_PhyUpperBound, 0xffff0000); 200 } 201 202 /** 203 * init_ohci1394_reset_and_init_dma - init controller and enable DMA 204 * This initializes the given controller and enables physical DMA engine in it. 205 */ init_ohci1394_reset_and_init_dma(struct ohci * ohci)206 static inline void __init init_ohci1394_reset_and_init_dma(struct ohci *ohci) 207 { 208 /* Start off with a soft reset, clears everything to a sane state. */ 209 init_ohci1394_soft_reset(ohci); 210 211 /* Accessing some registers without LPS enabled may cause lock up */ 212 reg_write(ohci, OHCI1394_HCControlSet, OHCI1394_HCControl_LPS); 213 214 /* Disable and clear interrupts */ 215 reg_write(ohci, OHCI1394_IntEventClear, 0xffffffff); 216 reg_write(ohci, OHCI1394_IntMaskClear, 0xffffffff); 217 218 mdelay(50); /* Wait 50msec to make sure we have full link enabled */ 219 220 init_ohci1394_initialize(ohci); 221 /* 222 * The initialization causes at least one IEEE1394 bus reset. Enabling 223 * physical DMA only works *after* *all* bus resets have calmed down: 224 */ 225 init_ohci1394_wait_for_busresets(ohci); 226 227 /* We had to wait and do this now if we want to debug early problems */ 228 init_ohci1394_enable_physical_dma(ohci); 229 } 230 231 /** 232 * init_ohci1394_controller - Map the registers of the controller and init DMA 233 * This maps the registers of the specified controller and initializes it 234 */ init_ohci1394_controller(int num,int slot,int func)235 static inline void __init init_ohci1394_controller(int num, int slot, int func) 236 { 237 unsigned long ohci_base; 238 struct ohci ohci; 239 240 printk(KERN_INFO "init_ohci1394_dma: initializing OHCI-1394" 241 " at %02x:%02x.%x\n", num, slot, func); 242 243 ohci_base = read_pci_config(num, slot, func, PCI_BASE_ADDRESS_0+(0<<2)) 244 & PCI_BASE_ADDRESS_MEM_MASK; 245 246 set_fixmap_nocache(FIX_OHCI1394_BASE, ohci_base); 247 248 ohci.registers = (void __iomem *)fix_to_virt(FIX_OHCI1394_BASE); 249 250 init_ohci1394_reset_and_init_dma(&ohci); 251 } 252 253 /** 254 * init_ohci1394_dma_on_all_controllers - scan for OHCI1394 controllers and init DMA on them 255 * Scans the whole PCI space for OHCI1394 controllers and inits DMA on them 256 */ init_ohci1394_dma_on_all_controllers(void)257 void __init init_ohci1394_dma_on_all_controllers(void) 258 { 259 int num, slot, func; 260 u32 class; 261 262 if (!early_pci_allowed()) 263 return; 264 265 /* Poor man's PCI discovery, the only thing we can do at early boot */ 266 for (num = 0; num < 32; num++) { 267 for (slot = 0; slot < 32; slot++) { 268 for (func = 0; func < 8; func++) { 269 class = read_pci_config(num, slot, func, 270 PCI_CLASS_REVISION); 271 if (class == 0xffffffff) 272 continue; /* No device at this func */ 273 274 if (class>>8 != PCI_CLASS_SERIAL_FIREWIRE_OHCI) 275 continue; /* Not an OHCI-1394 device */ 276 277 init_ohci1394_controller(num, slot, func); 278 break; /* Assume one controller per device */ 279 } 280 } 281 } 282 printk(KERN_INFO "init_ohci1394_dma: finished initializing OHCI DMA\n"); 283 } 284 285 /** 286 * setup_ohci1394_dma - enables early OHCI1394 DMA initialization 287 */ setup_ohci1394_dma(char * opt)288 static int __init setup_ohci1394_dma(char *opt) 289 { 290 if (!strcmp(opt, "early")) 291 init_ohci1394_dma_early = 1; 292 return 0; 293 } 294 295 /* passing ohci1394_dma=early on boot causes early OHCI1394 DMA initialization */ 296 early_param("ohci1394_dma", setup_ohci1394_dma); 297