set up dma_ops appropriately
[linux-2.6-block.git] / arch / ia64 / hp / common / sba_iommu.c
CommitLineData
1da177e4
LT
1/*
2** IA64 System Bus Adapter (SBA) I/O MMU manager
3**
5f6602a1 4** (c) Copyright 2002-2005 Alex Williamson
1da177e4 5** (c) Copyright 2002-2003 Grant Grundler
5f6602a1 6** (c) Copyright 2002-2005 Hewlett-Packard Company
1da177e4
LT
7**
8** Portions (c) 2000 Grant Grundler (from parisc I/O MMU code)
9** Portions (c) 1999 Dave S. Miller (from sparc64 I/O MMU code)
10**
11** This program is free software; you can redistribute it and/or modify
12** it under the terms of the GNU General Public License as published by
13** the Free Software Foundation; either version 2 of the License, or
14** (at your option) any later version.
15**
16**
17** This module initializes the IOC (I/O Controller) found on HP
18** McKinley machines and their successors.
19**
20*/
21
1da177e4
LT
22#include <linux/types.h>
23#include <linux/kernel.h>
24#include <linux/module.h>
25#include <linux/spinlock.h>
26#include <linux/slab.h>
27#include <linux/init.h>
28#include <linux/mm.h>
29#include <linux/string.h>
30#include <linux/pci.h>
31#include <linux/proc_fs.h>
32#include <linux/seq_file.h>
33#include <linux/acpi.h>
34#include <linux/efi.h>
35#include <linux/nodemask.h>
36#include <linux/bitops.h> /* hweight64() */
51b58e3e 37#include <linux/crash_dump.h>
b34eb53c 38#include <linux/iommu-helper.h>
0e9cbb9b 39#include <linux/dma-mapping.h>
1da177e4
LT
40
41#include <asm/delay.h> /* ia64_get_itc() */
42#include <asm/io.h>
43#include <asm/page.h> /* PAGE_OFFSET */
44#include <asm/dma.h>
45#include <asm/system.h> /* wmb() */
46
47#include <asm/acpi-ext.h>
48
51b58e3e
TL
49extern int swiotlb_late_init_with_default_size (size_t size);
50
1da177e4
LT
51#define PFX "IOC: "
52
53/*
54** Enabling timing search of the pdir resource map. Output in /proc.
55** Disabled by default to optimize performance.
56*/
57#undef PDIR_SEARCH_TIMING
58
59/*
60** This option allows cards capable of 64bit DMA to bypass the IOMMU. If
61** not defined, all DMA will be 32bit and go through the TLB.
62** There's potentially a conflict in the bio merge code with us
63** advertising an iommu, but then bypassing it. Since I/O MMU bypassing
64** appears to give more performance than bio-level virtual merging, we'll
65** do the former for now. NOTE: BYPASS_SG also needs to be undef'd to
66** completely restrict DMA to the IOMMU.
67*/
68#define ALLOW_IOV_BYPASS
69
70/*
71** This option specifically allows/disallows bypassing scatterlists with
72** multiple entries. Coalescing these entries can allow better DMA streaming
73** and in some cases shows better performance than entirely bypassing the
74** IOMMU. Performance increase on the order of 1-2% sequential output/input
75** using bonnie++ on a RAID0 MD device (sym2 & mpt).
76*/
77#undef ALLOW_IOV_BYPASS_SG
78
79/*
80** If a device prefetches beyond the end of a valid pdir entry, it will cause
81** a hard failure, ie. MCA. Version 3.0 and later of the zx1 LBA should
82** disconnect on 4k boundaries and prevent such issues. If the device is
0779bf2d 83** particularly aggressive, this option will keep the entire pdir valid such
1da177e4
LT
84** that prefetching will hit a valid address. This could severely impact
85** error containment, and is therefore off by default. The page that is
86** used for spill-over is poisoned, so that should help debugging somewhat.
87*/
88#undef FULL_VALID_PDIR
89
90#define ENABLE_MARK_CLEAN
91
92/*
93** The number of debug flags is a clue - this code is fragile. NOTE: since
94** tightening the use of res_lock the resource bitmap and actual pdir are no
95** longer guaranteed to stay in sync. The sanity checking code isn't going to
96** like that.
97*/
98#undef DEBUG_SBA_INIT
99#undef DEBUG_SBA_RUN
100#undef DEBUG_SBA_RUN_SG
101#undef DEBUG_SBA_RESOURCE
102#undef ASSERT_PDIR_SANITY
103#undef DEBUG_LARGE_SG_ENTRIES
104#undef DEBUG_BYPASS
105
106#if defined(FULL_VALID_PDIR) && defined(ASSERT_PDIR_SANITY)
107#error FULL_VALID_PDIR and ASSERT_PDIR_SANITY are mutually exclusive
108#endif
109
110#define SBA_INLINE __inline__
111/* #define SBA_INLINE */
112
113#ifdef DEBUG_SBA_INIT
114#define DBG_INIT(x...) printk(x)
115#else
116#define DBG_INIT(x...)
117#endif
118
119#ifdef DEBUG_SBA_RUN
120#define DBG_RUN(x...) printk(x)
121#else
122#define DBG_RUN(x...)
123#endif
124
125#ifdef DEBUG_SBA_RUN_SG
126#define DBG_RUN_SG(x...) printk(x)
127#else
128#define DBG_RUN_SG(x...)
129#endif
130
131
132#ifdef DEBUG_SBA_RESOURCE
133#define DBG_RES(x...) printk(x)
134#else
135#define DBG_RES(x...)
136#endif
137
138#ifdef DEBUG_BYPASS
139#define DBG_BYPASS(x...) printk(x)
140#else
141#define DBG_BYPASS(x...)
142#endif
143
144#ifdef ASSERT_PDIR_SANITY
145#define ASSERT(expr) \
146 if(!(expr)) { \
147 printk( "\n" __FILE__ ":%d: Assertion " #expr " failed!\n",__LINE__); \
148 panic(#expr); \
149 }
150#else
151#define ASSERT(expr)
152#endif
153
154/*
155** The number of pdir entries to "free" before issuing
156** a read to PCOM register to flush out PCOM writes.
157** Interacts with allocation granularity (ie 4 or 8 entries
158** allocated and free'd/purged at a time might make this
159** less interesting).
160*/
161#define DELAYED_RESOURCE_CNT 64
162
e15da401
BH
163#define PCI_DEVICE_ID_HP_SX2000_IOC 0x12ec
164
1da177e4
LT
165#define ZX1_IOC_ID ((PCI_DEVICE_ID_HP_ZX1_IOC << 16) | PCI_VENDOR_ID_HP)
166#define ZX2_IOC_ID ((PCI_DEVICE_ID_HP_ZX2_IOC << 16) | PCI_VENDOR_ID_HP)
167#define REO_IOC_ID ((PCI_DEVICE_ID_HP_REO_IOC << 16) | PCI_VENDOR_ID_HP)
168#define SX1000_IOC_ID ((PCI_DEVICE_ID_HP_SX1000_IOC << 16) | PCI_VENDOR_ID_HP)
e15da401 169#define SX2000_IOC_ID ((PCI_DEVICE_ID_HP_SX2000_IOC << 16) | PCI_VENDOR_ID_HP)
1da177e4
LT
170
171#define ZX1_IOC_OFFSET 0x1000 /* ACPI reports SBA, we want IOC */
172
173#define IOC_FUNC_ID 0x000
174#define IOC_FCLASS 0x008 /* function class, bist, header, rev... */
175#define IOC_IBASE 0x300 /* IO TLB */
176#define IOC_IMASK 0x308
177#define IOC_PCOM 0x310
178#define IOC_TCNFG 0x318
179#define IOC_PDIR_BASE 0x320
180
181#define IOC_ROPE0_CFG 0x500
182#define IOC_ROPE_AO 0x10 /* Allow "Relaxed Ordering" */
183
184
185/* AGP GART driver looks for this */
186#define ZX1_SBA_IOMMU_COOKIE 0x0000badbadc0ffeeUL
187
188/*
189** The zx1 IOC supports 4/8/16/64KB page sizes (see TCNFG register)
190**
191** Some IOCs (sx1000) can run at the above pages sizes, but are
192** really only supported using the IOC at a 4k page size.
193**
194** iovp_size could only be greater than PAGE_SIZE if we are
195** confident the drivers really only touch the next physical
196** page iff that driver instance owns it.
197*/
198static unsigned long iovp_size;
199static unsigned long iovp_shift;
200static unsigned long iovp_mask;
201
202struct ioc {
203 void __iomem *ioc_hpa; /* I/O MMU base address */
204 char *res_map; /* resource map, bit == pdir entry */
205 u64 *pdir_base; /* physical base address */
206 unsigned long ibase; /* pdir IOV Space base */
207 unsigned long imask; /* pdir IOV Space mask */
208
209 unsigned long *res_hint; /* next avail IOVP - circular search */
210 unsigned long dma_mask;
211 spinlock_t res_lock; /* protects the resource bitmap, but must be held when */
212 /* clearing pdir to prevent races with allocations. */
213 unsigned int res_bitshift; /* from the RIGHT! */
214 unsigned int res_size; /* size of resource map in bytes */
215#ifdef CONFIG_NUMA
216 unsigned int node; /* node where this IOC lives */
217#endif
218#if DELAYED_RESOURCE_CNT > 0
219 spinlock_t saved_lock; /* may want to try to get this on a separate cacheline */
220 /* than res_lock for bigger systems. */
221 int saved_cnt;
222 struct sba_dma_pair {
223 dma_addr_t iova;
224 size_t size;
225 } saved[DELAYED_RESOURCE_CNT];
226#endif
227
228#ifdef PDIR_SEARCH_TIMING
229#define SBA_SEARCH_SAMPLE 0x100
230 unsigned long avg_search[SBA_SEARCH_SAMPLE];
231 unsigned long avg_idx; /* current index into avg_search */
232#endif
233
234 /* Stuff we don't need in performance path */
235 struct ioc *next; /* list of IOC's in system */
236 acpi_handle handle; /* for multiple IOC's */
237 const char *name;
238 unsigned int func_id;
239 unsigned int rev; /* HW revision of chip */
240 u32 iov_size;
241 unsigned int pdir_size; /* in bytes, determined by IOV Space size */
242 struct pci_dev *sac_only_dev;
243};
244
245static struct ioc *ioc_list;
246static int reserve_sba_gart = 1;
247
248static SBA_INLINE void sba_mark_invalid(struct ioc *, dma_addr_t, size_t);
249static SBA_INLINE void sba_free_range(struct ioc *, dma_addr_t, size_t);
250
58b053e4 251#define sba_sg_address(sg) sg_virt((sg))
1da177e4
LT
252
253#ifdef FULL_VALID_PDIR
254static u64 prefetch_spill_page;
255#endif
256
257#ifdef CONFIG_PCI
258# define GET_IOC(dev) (((dev)->bus == &pci_bus_type) \
259 ? ((struct ioc *) PCI_CONTROLLER(to_pci_dev(dev))->iommu) : NULL)
260#else
261# define GET_IOC(dev) NULL
262#endif
263
264/*
265** DMA_CHUNK_SIZE is used by the SCSI mid-layer to break up
0779bf2d 266** (or rather not merge) DMAs into manageable chunks.
1da177e4 267** On parisc, this is more of the software/tuning constraint
0779bf2d
ML
268** rather than the HW. I/O MMU allocation algorithms can be
269** faster with smaller sizes (to some degree).
1da177e4
LT
270*/
271#define DMA_CHUNK_SIZE (BITS_PER_LONG*iovp_size)
272
273#define ROUNDUP(x,y) ((x + ((y)-1)) & ~((y)-1))
274
275/************************************
276** SBA register read and write support
277**
278** BE WARNED: register writes are posted.
279** (ie follow writes which must reach HW with a read)
280**
281*/
282#define READ_REG(addr) __raw_readq(addr)
283#define WRITE_REG(val, addr) __raw_writeq(val, addr)
284
285#ifdef DEBUG_SBA_INIT
286
287/**
288 * sba_dump_tlb - debugging only - print IOMMU operating parameters
289 * @hpa: base address of the IOMMU
290 *
291 * Print the size/location of the IO MMU PDIR.
292 */
293static void
294sba_dump_tlb(char *hpa)
295{
296 DBG_INIT("IO TLB at 0x%p\n", (void *)hpa);
297 DBG_INIT("IOC_IBASE : %016lx\n", READ_REG(hpa+IOC_IBASE));
298 DBG_INIT("IOC_IMASK : %016lx\n", READ_REG(hpa+IOC_IMASK));
299 DBG_INIT("IOC_TCNFG : %016lx\n", READ_REG(hpa+IOC_TCNFG));
300 DBG_INIT("IOC_PDIR_BASE: %016lx\n", READ_REG(hpa+IOC_PDIR_BASE));
301 DBG_INIT("\n");
302}
303#endif
304
305
306#ifdef ASSERT_PDIR_SANITY
307
308/**
309 * sba_dump_pdir_entry - debugging only - print one IOMMU PDIR entry
310 * @ioc: IO MMU structure which owns the pdir we are interested in.
311 * @msg: text to print ont the output line.
312 * @pide: pdir index.
313 *
314 * Print one entry of the IO MMU PDIR in human readable form.
315 */
316static void
317sba_dump_pdir_entry(struct ioc *ioc, char *msg, uint pide)
318{
319 /* start printing from lowest pde in rval */
320 u64 *ptr = &ioc->pdir_base[pide & ~(BITS_PER_LONG - 1)];
321 unsigned long *rptr = (unsigned long *) &ioc->res_map[(pide >>3) & -sizeof(unsigned long)];
322 uint rcnt;
323
324 printk(KERN_DEBUG "SBA: %s rp %p bit %d rval 0x%lx\n",
325 msg, rptr, pide & (BITS_PER_LONG - 1), *rptr);
326
327 rcnt = 0;
328 while (rcnt < BITS_PER_LONG) {
329 printk(KERN_DEBUG "%s %2d %p %016Lx\n",
330 (rcnt == (pide & (BITS_PER_LONG - 1)))
331 ? " -->" : " ",
332 rcnt, ptr, (unsigned long long) *ptr );
333 rcnt++;
334 ptr++;
335 }
336 printk(KERN_DEBUG "%s", msg);
337}
338
339
340/**
341 * sba_check_pdir - debugging only - consistency checker
342 * @ioc: IO MMU structure which owns the pdir we are interested in.
343 * @msg: text to print ont the output line.
344 *
345 * Verify the resource map and pdir state is consistent
346 */
347static int
348sba_check_pdir(struct ioc *ioc, char *msg)
349{
350 u64 *rptr_end = (u64 *) &(ioc->res_map[ioc->res_size]);
351 u64 *rptr = (u64 *) ioc->res_map; /* resource map ptr */
352 u64 *pptr = ioc->pdir_base; /* pdir ptr */
353 uint pide = 0;
354
355 while (rptr < rptr_end) {
356 u64 rval;
357 int rcnt; /* number of bits we might check */
358
359 rval = *rptr;
360 rcnt = 64;
361
362 while (rcnt) {
363 /* Get last byte and highest bit from that */
364 u32 pde = ((u32)((*pptr >> (63)) & 0x1));
365 if ((rval & 0x1) ^ pde)
366 {
367 /*
368 ** BUMMER! -- res_map != pdir --
369 ** Dump rval and matching pdir entries
370 */
371 sba_dump_pdir_entry(ioc, msg, pide);
372 return(1);
373 }
374 rcnt--;
375 rval >>= 1; /* try the next bit */
376 pptr++;
377 pide++;
378 }
379 rptr++; /* look at next word of res_map */
380 }
381 /* It'd be nice if we always got here :^) */
382 return 0;
383}
384
385
386/**
387 * sba_dump_sg - debugging only - print Scatter-Gather list
388 * @ioc: IO MMU structure which owns the pdir we are interested in.
389 * @startsg: head of the SG list
390 * @nents: number of entries in SG list
391 *
392 * print the SG list so we can verify it's correct by hand.
393 */
394static void
395sba_dump_sg( struct ioc *ioc, struct scatterlist *startsg, int nents)
396{
397 while (nents-- > 0) {
398 printk(KERN_DEBUG " %d : DMA %08lx/%05x CPU %p\n", nents,
399 startsg->dma_address, startsg->dma_length,
400 sba_sg_address(startsg));
9b6eccfc 401 startsg = sg_next(startsg);
1da177e4
LT
402 }
403}
404
405static void
406sba_check_sg( struct ioc *ioc, struct scatterlist *startsg, int nents)
407{
408 struct scatterlist *the_sg = startsg;
409 int the_nents = nents;
410
411 while (the_nents-- > 0) {
412 if (sba_sg_address(the_sg) == 0x0UL)
413 sba_dump_sg(NULL, startsg, nents);
9b6eccfc 414 the_sg = sg_next(the_sg);
1da177e4
LT
415 }
416}
417
418#endif /* ASSERT_PDIR_SANITY */
419
420
421
422
423/**************************************************************
424*
425* I/O Pdir Resource Management
426*
427* Bits set in the resource map are in use.
428* Each bit can represent a number of pages.
429* LSbs represent lower addresses (IOVA's).
430*
431***************************************************************/
432#define PAGES_PER_RANGE 1 /* could increase this to 4 or 8 if needed */
433
434/* Convert from IOVP to IOVA and vice versa. */
435#define SBA_IOVA(ioc,iovp,offset) ((ioc->ibase) | (iovp) | (offset))
436#define SBA_IOVP(ioc,iova) ((iova) & ~(ioc->ibase))
437
438#define PDIR_ENTRY_SIZE sizeof(u64)
439
440#define PDIR_INDEX(iovp) ((iovp)>>iovp_shift)
441
442#define RESMAP_MASK(n) ~(~0UL << (n))
443#define RESMAP_IDX_MASK (sizeof(unsigned long) - 1)
444
445
446/**
447 * For most cases the normal get_order is sufficient, however it limits us
448 * to PAGE_SIZE being the minimum mapping alignment and TC flush granularity.
449 * It only incurs about 1 clock cycle to use this one with the static variable
450 * and makes the code more intuitive.
451 */
452static SBA_INLINE int
453get_iovp_order (unsigned long size)
454{
455 long double d = size - 1;
456 long order;
457
458 order = ia64_getf_exp(d);
459 order = order - iovp_shift - 0xffff + 1;
460 if (order < 0)
461 order = 0;
462 return order;
463}
464
b34eb53c
FT
465static unsigned long ptr_to_pide(struct ioc *ioc, unsigned long *res_ptr,
466 unsigned int bitshiftcnt)
467{
468 return (((unsigned long)res_ptr - (unsigned long)ioc->res_map) << 3)
469 + bitshiftcnt;
470}
471
1da177e4
LT
472/**
473 * sba_search_bitmap - find free space in IO PDIR resource bitmap
474 * @ioc: IO MMU structure which owns the pdir we are interested in.
475 * @bits_wanted: number of entries we need.
5f6602a1 476 * @use_hint: use res_hint to indicate where to start looking
1da177e4
LT
477 *
478 * Find consecutive free bits in resource bitmap.
479 * Each bit represents one entry in the IO Pdir.
480 * Cool perf optimization: search for log2(size) bits at a time.
481 */
482static SBA_INLINE unsigned long
b34eb53c
FT
483sba_search_bitmap(struct ioc *ioc, struct device *dev,
484 unsigned long bits_wanted, int use_hint)
1da177e4 485{
5f6602a1 486 unsigned long *res_ptr;
1da177e4 487 unsigned long *res_end = (unsigned long *) &(ioc->res_map[ioc->res_size]);
b34eb53c
FT
488 unsigned long flags, pide = ~0UL, tpide;
489 unsigned long boundary_size;
490 unsigned long shift;
491 int ret;
1da177e4
LT
492
493 ASSERT(((unsigned long) ioc->res_hint & (sizeof(unsigned long) - 1UL)) == 0);
494 ASSERT(res_ptr < res_end);
495
b34eb53c
FT
496 boundary_size = (unsigned long long)dma_get_seg_boundary(dev) + 1;
497 boundary_size = ALIGN(boundary_size, 1ULL << iovp_shift) >> iovp_shift;
498
499 BUG_ON(ioc->ibase & ~iovp_mask);
500 shift = ioc->ibase >> iovp_shift;
501
5f6602a1
AW
502 spin_lock_irqsave(&ioc->res_lock, flags);
503
504 /* Allow caller to force a search through the entire resource space */
505 if (likely(use_hint)) {
506 res_ptr = ioc->res_hint;
507 } else {
508 res_ptr = (ulong *)ioc->res_map;
509 ioc->res_bitshift = 0;
510 }
511
1da177e4
LT
512 /*
513 * N.B. REO/Grande defect AR2305 can cause TLB fetch timeouts
514 * if a TLB entry is purged while in use. sba_mark_invalid()
515 * purges IOTLB entries in power-of-two sizes, so we also
516 * allocate IOVA space in power-of-two sizes.
517 */
518 bits_wanted = 1UL << get_iovp_order(bits_wanted << iovp_shift);
519
520 if (likely(bits_wanted == 1)) {
521 unsigned int bitshiftcnt;
522 for(; res_ptr < res_end ; res_ptr++) {
523 if (likely(*res_ptr != ~0UL)) {
524 bitshiftcnt = ffz(*res_ptr);
525 *res_ptr |= (1UL << bitshiftcnt);
b34eb53c 526 pide = ptr_to_pide(ioc, res_ptr, bitshiftcnt);
1da177e4
LT
527 ioc->res_bitshift = bitshiftcnt + bits_wanted;
528 goto found_it;
529 }
530 }
531 goto not_found;
532
533 }
534
535 if (likely(bits_wanted <= BITS_PER_LONG/2)) {
536 /*
537 ** Search the resource bit map on well-aligned values.
538 ** "o" is the alignment.
539 ** We need the alignment to invalidate I/O TLB using
540 ** SBA HW features in the unmap path.
541 */
542 unsigned long o = 1 << get_iovp_order(bits_wanted << iovp_shift);
543 uint bitshiftcnt = ROUNDUP(ioc->res_bitshift, o);
544 unsigned long mask, base_mask;
545
546 base_mask = RESMAP_MASK(bits_wanted);
547 mask = base_mask << bitshiftcnt;
548
d4ed8084 549 DBG_RES("%s() o %ld %p", __func__, o, res_ptr);
1da177e4
LT
550 for(; res_ptr < res_end ; res_ptr++)
551 {
552 DBG_RES(" %p %lx %lx\n", res_ptr, mask, *res_ptr);
553 ASSERT(0 != mask);
554 for (; mask ; mask <<= o, bitshiftcnt += o) {
b34eb53c
FT
555 tpide = ptr_to_pide(ioc, res_ptr, bitshiftcnt);
556 ret = iommu_is_span_boundary(tpide, bits_wanted,
557 shift,
558 boundary_size);
559 if ((0 == ((*res_ptr) & mask)) && !ret) {
1da177e4 560 *res_ptr |= mask; /* mark resources busy! */
b34eb53c 561 pide = tpide;
1da177e4
LT
562 ioc->res_bitshift = bitshiftcnt + bits_wanted;
563 goto found_it;
564 }
565 }
566
567 bitshiftcnt = 0;
568 mask = base_mask;
569
570 }
571
572 } else {
573 int qwords, bits, i;
574 unsigned long *end;
575
576 qwords = bits_wanted >> 6; /* /64 */
577 bits = bits_wanted - (qwords * BITS_PER_LONG);
578
579 end = res_end - qwords;
580
581 for (; res_ptr < end; res_ptr++) {
b34eb53c
FT
582 tpide = ptr_to_pide(ioc, res_ptr, 0);
583 ret = iommu_is_span_boundary(tpide, bits_wanted,
584 shift, boundary_size);
585 if (ret)
586 goto next_ptr;
1da177e4
LT
587 for (i = 0 ; i < qwords ; i++) {
588 if (res_ptr[i] != 0)
589 goto next_ptr;
590 }
591 if (bits && res_ptr[i] && (__ffs(res_ptr[i]) < bits))
592 continue;
593
594 /* Found it, mark it */
595 for (i = 0 ; i < qwords ; i++)
596 res_ptr[i] = ~0UL;
597 res_ptr[i] |= RESMAP_MASK(bits);
598
b34eb53c 599 pide = tpide;
1da177e4
LT
600 res_ptr += qwords;
601 ioc->res_bitshift = bits;
602 goto found_it;
603next_ptr:
604 ;
605 }
606 }
607
608not_found:
609 prefetch(ioc->res_map);
610 ioc->res_hint = (unsigned long *) ioc->res_map;
611 ioc->res_bitshift = 0;
5f6602a1 612 spin_unlock_irqrestore(&ioc->res_lock, flags);
1da177e4
LT
613 return (pide);
614
615found_it:
616 ioc->res_hint = res_ptr;
5f6602a1 617 spin_unlock_irqrestore(&ioc->res_lock, flags);
1da177e4
LT
618 return (pide);
619}
620
621
622/**
623 * sba_alloc_range - find free bits and mark them in IO PDIR resource bitmap
624 * @ioc: IO MMU structure which owns the pdir we are interested in.
625 * @size: number of bytes to create a mapping for
626 *
627 * Given a size, find consecutive unmarked and then mark those bits in the
628 * resource bit map.
629 */
630static int
b34eb53c 631sba_alloc_range(struct ioc *ioc, struct device *dev, size_t size)
1da177e4
LT
632{
633 unsigned int pages_needed = size >> iovp_shift;
634#ifdef PDIR_SEARCH_TIMING
635 unsigned long itc_start;
636#endif
637 unsigned long pide;
1da177e4
LT
638
639 ASSERT(pages_needed);
640 ASSERT(0 == (size & ~iovp_mask));
641
1da177e4
LT
642#ifdef PDIR_SEARCH_TIMING
643 itc_start = ia64_get_itc();
644#endif
645 /*
646 ** "seek and ye shall find"...praying never hurts either...
647 */
b34eb53c 648 pide = sba_search_bitmap(ioc, dev, pages_needed, 1);
1da177e4 649 if (unlikely(pide >= (ioc->res_size << 3))) {
b34eb53c 650 pide = sba_search_bitmap(ioc, dev, pages_needed, 0);
1da177e4
LT
651 if (unlikely(pide >= (ioc->res_size << 3))) {
652#if DELAYED_RESOURCE_CNT > 0
5f6602a1
AW
653 unsigned long flags;
654
1da177e4
LT
655 /*
656 ** With delayed resource freeing, we can give this one more shot. We're
657 ** getting close to being in trouble here, so do what we can to make this
658 ** one count.
659 */
5f6602a1 660 spin_lock_irqsave(&ioc->saved_lock, flags);
1da177e4
LT
661 if (ioc->saved_cnt > 0) {
662 struct sba_dma_pair *d;
663 int cnt = ioc->saved_cnt;
664
5f6602a1 665 d = &(ioc->saved[ioc->saved_cnt - 1]);
1da177e4 666
5f6602a1 667 spin_lock(&ioc->res_lock);
1da177e4
LT
668 while (cnt--) {
669 sba_mark_invalid(ioc, d->iova, d->size);
670 sba_free_range(ioc, d->iova, d->size);
671 d--;
672 }
673 ioc->saved_cnt = 0;
674 READ_REG(ioc->ioc_hpa+IOC_PCOM); /* flush purges */
5f6602a1 675 spin_unlock(&ioc->res_lock);
1da177e4 676 }
5f6602a1 677 spin_unlock_irqrestore(&ioc->saved_lock, flags);
1da177e4 678
b34eb53c 679 pide = sba_search_bitmap(ioc, dev, pages_needed, 0);
1da177e4
LT
680 if (unlikely(pide >= (ioc->res_size << 3)))
681 panic(__FILE__ ": I/O MMU @ %p is out of mapping resources\n",
682 ioc->ioc_hpa);
683#else
684 panic(__FILE__ ": I/O MMU @ %p is out of mapping resources\n",
685 ioc->ioc_hpa);
686#endif
687 }
688 }
689
690#ifdef PDIR_SEARCH_TIMING
691 ioc->avg_search[ioc->avg_idx++] = (ia64_get_itc() - itc_start) / pages_needed;
692 ioc->avg_idx &= SBA_SEARCH_SAMPLE - 1;
693#endif
694
695 prefetchw(&(ioc->pdir_base[pide]));
696
697#ifdef ASSERT_PDIR_SANITY
698 /* verify the first enable bit is clear */
699 if(0x00 != ((u8 *) ioc->pdir_base)[pide*PDIR_ENTRY_SIZE + 7]) {
700 sba_dump_pdir_entry(ioc, "sba_search_bitmap() botched it?", pide);
701 }
702#endif
703
704 DBG_RES("%s(%x) %d -> %lx hint %x/%x\n",
d4ed8084 705 __func__, size, pages_needed, pide,
1da177e4
LT
706 (uint) ((unsigned long) ioc->res_hint - (unsigned long) ioc->res_map),
707 ioc->res_bitshift );
708
1da177e4
LT
709 return (pide);
710}
711
712
713/**
714 * sba_free_range - unmark bits in IO PDIR resource bitmap
715 * @ioc: IO MMU structure which owns the pdir we are interested in.
716 * @iova: IO virtual address which was previously allocated.
717 * @size: number of bytes to create a mapping for
718 *
719 * clear bits in the ioc's resource map
720 */
721static SBA_INLINE void
722sba_free_range(struct ioc *ioc, dma_addr_t iova, size_t size)
723{
724 unsigned long iovp = SBA_IOVP(ioc, iova);
725 unsigned int pide = PDIR_INDEX(iovp);
726 unsigned int ridx = pide >> 3; /* convert bit to byte address */
727 unsigned long *res_ptr = (unsigned long *) &((ioc)->res_map[ridx & ~RESMAP_IDX_MASK]);
728 int bits_not_wanted = size >> iovp_shift;
729 unsigned long m;
730
731 /* Round up to power-of-two size: see AR2305 note above */
732 bits_not_wanted = 1UL << get_iovp_order(bits_not_wanted << iovp_shift);
733 for (; bits_not_wanted > 0 ; res_ptr++) {
734
735 if (unlikely(bits_not_wanted > BITS_PER_LONG)) {
736
737 /* these mappings start 64bit aligned */
738 *res_ptr = 0UL;
739 bits_not_wanted -= BITS_PER_LONG;
740 pide += BITS_PER_LONG;
741
742 } else {
743
744 /* 3-bits "bit" address plus 2 (or 3) bits for "byte" == bit in word */
745 m = RESMAP_MASK(bits_not_wanted) << (pide & (BITS_PER_LONG - 1));
746 bits_not_wanted = 0;
747
d4ed8084
HH
748 DBG_RES("%s( ,%x,%x) %x/%lx %x %p %lx\n", __func__, (uint) iova, size,
749 bits_not_wanted, m, pide, res_ptr, *res_ptr);
1da177e4
LT
750
751 ASSERT(m != 0);
752 ASSERT(bits_not_wanted);
753 ASSERT((*res_ptr & m) == m); /* verify same bits are set */
754 *res_ptr &= ~m;
755 }
756 }
757}
758
759
760/**************************************************************
761*
762* "Dynamic DMA Mapping" support (aka "Coherent I/O")
763*
764***************************************************************/
765
766/**
767 * sba_io_pdir_entry - fill in one IO PDIR entry
768 * @pdir_ptr: pointer to IO PDIR entry
769 * @vba: Virtual CPU address of buffer to map
770 *
771 * SBA Mapping Routine
772 *
773 * Given a virtual address (vba, arg1) sba_io_pdir_entry()
774 * loads the I/O PDIR entry pointed to by pdir_ptr (arg0).
775 * Each IO Pdir entry consists of 8 bytes as shown below
776 * (LSB == bit 0):
777 *
778 * 63 40 11 7 0
779 * +-+---------------------+----------------------------------+----+--------+
780 * |V| U | PPN[39:12] | U | FF |
781 * +-+---------------------+----------------------------------+----+--------+
782 *
783 * V == Valid Bit
784 * U == Unused
785 * PPN == Physical Page Number
786 *
787 * The physical address fields are filled with the results of virt_to_phys()
788 * on the vba.
789 */
790
791#if 1
792#define sba_io_pdir_entry(pdir_ptr, vba) *pdir_ptr = ((vba & ~0xE000000000000FFFULL) \
793 | 0x8000000000000000ULL)
794#else
795void SBA_INLINE
796sba_io_pdir_entry(u64 *pdir_ptr, unsigned long vba)
797{
798 *pdir_ptr = ((vba & ~0xE000000000000FFFULL) | 0x80000000000000FFULL);
799}
800#endif
801
802#ifdef ENABLE_MARK_CLEAN
803/**
804 * Since DMA is i-cache coherent, any (complete) pages that were written via
805 * DMA can be marked as "clean" so that lazy_mmu_prot_update() doesn't have to
806 * flush them when they get mapped into an executable vm-area.
807 */
808static void
809mark_clean (void *addr, size_t size)
810{
811 unsigned long pg_addr, end;
812
813 pg_addr = PAGE_ALIGN((unsigned long) addr);
814 end = (unsigned long) addr + size;
815 while (pg_addr + PAGE_SIZE <= end) {
816 struct page *page = virt_to_page((void *)pg_addr);
817 set_bit(PG_arch_1, &page->flags);
818 pg_addr += PAGE_SIZE;
819 }
820}
821#endif
822
823/**
824 * sba_mark_invalid - invalidate one or more IO PDIR entries
825 * @ioc: IO MMU structure which owns the pdir we are interested in.
826 * @iova: IO Virtual Address mapped earlier
827 * @byte_cnt: number of bytes this mapping covers.
828 *
829 * Marking the IO PDIR entry(ies) as Invalid and invalidate
830 * corresponding IO TLB entry. The PCOM (Purge Command Register)
831 * is to purge stale entries in the IO TLB when unmapping entries.
832 *
833 * The PCOM register supports purging of multiple pages, with a minium
834 * of 1 page and a maximum of 2GB. Hardware requires the address be
835 * aligned to the size of the range being purged. The size of the range
836 * must be a power of 2. The "Cool perf optimization" in the
837 * allocation routine helps keep that true.
838 */
839static SBA_INLINE void
840sba_mark_invalid(struct ioc *ioc, dma_addr_t iova, size_t byte_cnt)
841{
842 u32 iovp = (u32) SBA_IOVP(ioc,iova);
843
844 int off = PDIR_INDEX(iovp);
845
846 /* Must be non-zero and rounded up */
847 ASSERT(byte_cnt > 0);
848 ASSERT(0 == (byte_cnt & ~iovp_mask));
849
850#ifdef ASSERT_PDIR_SANITY
851 /* Assert first pdir entry is set */
852 if (!(ioc->pdir_base[off] >> 60)) {
853 sba_dump_pdir_entry(ioc,"sba_mark_invalid()", PDIR_INDEX(iovp));
854 }
855#endif
856
857 if (byte_cnt <= iovp_size)
858 {
859 ASSERT(off < ioc->pdir_size);
860
861 iovp |= iovp_shift; /* set "size" field for PCOM */
862
863#ifndef FULL_VALID_PDIR
864 /*
865 ** clear I/O PDIR entry "valid" bit
866 ** Do NOT clear the rest - save it for debugging.
867 ** We should only clear bits that have previously
868 ** been enabled.
869 */
870 ioc->pdir_base[off] &= ~(0x80000000000000FFULL);
871#else
872 /*
873 ** If we want to maintain the PDIR as valid, put in
874 ** the spill page so devices prefetching won't
875 ** cause a hard fail.
876 */
877 ioc->pdir_base[off] = (0x80000000000000FFULL | prefetch_spill_page);
878#endif
879 } else {
880 u32 t = get_iovp_order(byte_cnt) + iovp_shift;
881
882 iovp |= t;
883 ASSERT(t <= 31); /* 2GB! Max value of "size" field */
884
885 do {
886 /* verify this pdir entry is enabled */
887 ASSERT(ioc->pdir_base[off] >> 63);
888#ifndef FULL_VALID_PDIR
889 /* clear I/O Pdir entry "valid" bit first */
890 ioc->pdir_base[off] &= ~(0x80000000000000FFULL);
891#else
892 ioc->pdir_base[off] = (0x80000000000000FFULL | prefetch_spill_page);
893#endif
894 off++;
895 byte_cnt -= iovp_size;
896 } while (byte_cnt > 0);
897 }
898
899 WRITE_REG(iovp | ioc->ibase, ioc->ioc_hpa+IOC_PCOM);
900}
901
902/**
309df0c5 903 * sba_map_single_attrs - map one buffer and return IOVA for DMA
1da177e4
LT
904 * @dev: instance of PCI owned by the driver that's asking.
905 * @addr: driver buffer to map.
906 * @size: number of bytes to map in driver buffer.
907 * @dir: R/W or both.
309df0c5 908 * @attrs: optional dma attributes
1da177e4
LT
909 *
910 * See Documentation/DMA-mapping.txt
911 */
912dma_addr_t
309df0c5
AK
913sba_map_single_attrs(struct device *dev, void *addr, size_t size, int dir,
914 struct dma_attrs *attrs)
1da177e4
LT
915{
916 struct ioc *ioc;
917 dma_addr_t iovp;
918 dma_addr_t offset;
919 u64 *pdir_start;
920 int pide;
921#ifdef ASSERT_PDIR_SANITY
922 unsigned long flags;
923#endif
924#ifdef ALLOW_IOV_BYPASS
925 unsigned long pci_addr = virt_to_phys(addr);
926#endif
927
928#ifdef ALLOW_IOV_BYPASS
929 ASSERT(to_pci_dev(dev)->dma_mask);
930 /*
931 ** Check if the PCI device can DMA to ptr... if so, just return ptr
932 */
933 if (likely((pci_addr & ~to_pci_dev(dev)->dma_mask) == 0)) {
934 /*
935 ** Device is bit capable of DMA'ing to the buffer...
936 ** just return the PCI address of ptr
937 */
309df0c5
AK
938 DBG_BYPASS("sba_map_single_attrs() bypass mask/addr: "
939 "0x%lx/0x%lx\n",
1da177e4
LT
940 to_pci_dev(dev)->dma_mask, pci_addr);
941 return pci_addr;
942 }
943#endif
944 ioc = GET_IOC(dev);
945 ASSERT(ioc);
946
947 prefetch(ioc->res_hint);
948
949 ASSERT(size > 0);
950 ASSERT(size <= DMA_CHUNK_SIZE);
951
952 /* save offset bits */
953 offset = ((dma_addr_t) (long) addr) & ~iovp_mask;
954
955 /* round up to nearest iovp_size */
956 size = (size + offset + ~iovp_mask) & iovp_mask;
957
958#ifdef ASSERT_PDIR_SANITY
959 spin_lock_irqsave(&ioc->res_lock, flags);
309df0c5 960 if (sba_check_pdir(ioc,"Check before sba_map_single_attrs()"))
1da177e4
LT
961 panic("Sanity check failed");
962 spin_unlock_irqrestore(&ioc->res_lock, flags);
963#endif
964
b34eb53c 965 pide = sba_alloc_range(ioc, dev, size);
1da177e4
LT
966
967 iovp = (dma_addr_t) pide << iovp_shift;
968
d4ed8084 969 DBG_RUN("%s() 0x%p -> 0x%lx\n", __func__, addr, (long) iovp | offset);
1da177e4
LT
970
971 pdir_start = &(ioc->pdir_base[pide]);
972
973 while (size > 0) {
974 ASSERT(((u8 *)pdir_start)[7] == 0); /* verify availability */
975 sba_io_pdir_entry(pdir_start, (unsigned long) addr);
976
977 DBG_RUN(" pdir 0x%p %lx\n", pdir_start, *pdir_start);
978
979 addr += iovp_size;
980 size -= iovp_size;
981 pdir_start++;
982 }
983 /* force pdir update */
984 wmb();
985
986 /* form complete address */
987#ifdef ASSERT_PDIR_SANITY
988 spin_lock_irqsave(&ioc->res_lock, flags);
309df0c5 989 sba_check_pdir(ioc,"Check after sba_map_single_attrs()");
1da177e4
LT
990 spin_unlock_irqrestore(&ioc->res_lock, flags);
991#endif
992 return SBA_IOVA(ioc, iovp, offset);
993}
309df0c5 994EXPORT_SYMBOL(sba_map_single_attrs);
1da177e4 995
5f6602a1
AW
996#ifdef ENABLE_MARK_CLEAN
997static SBA_INLINE void
998sba_mark_clean(struct ioc *ioc, dma_addr_t iova, size_t size)
999{
1000 u32 iovp = (u32) SBA_IOVP(ioc,iova);
1001 int off = PDIR_INDEX(iovp);
1002 void *addr;
1003
1004 if (size <= iovp_size) {
1005 addr = phys_to_virt(ioc->pdir_base[off] &
1006 ~0xE000000000000FFFULL);
1007 mark_clean(addr, size);
1008 } else {
1009 do {
1010 addr = phys_to_virt(ioc->pdir_base[off] &
1011 ~0xE000000000000FFFULL);
1012 mark_clean(addr, min(size, iovp_size));
1013 off++;
1014 size -= iovp_size;
1015 } while (size > 0);
1016 }
1017}
1018#endif
1019
1da177e4 1020/**
309df0c5 1021 * sba_unmap_single_attrs - unmap one IOVA and free resources
1da177e4
LT
1022 * @dev: instance of PCI owned by the driver that's asking.
1023 * @iova: IOVA of driver buffer previously mapped.
1024 * @size: number of bytes mapped in driver buffer.
1025 * @dir: R/W or both.
309df0c5 1026 * @attrs: optional dma attributes
1da177e4
LT
1027 *
1028 * See Documentation/DMA-mapping.txt
1029 */
309df0c5
AK
1030void sba_unmap_single_attrs(struct device *dev, dma_addr_t iova, size_t size,
1031 int dir, struct dma_attrs *attrs)
1da177e4
LT
1032{
1033 struct ioc *ioc;
1034#if DELAYED_RESOURCE_CNT > 0
1035 struct sba_dma_pair *d;
1036#endif
1037 unsigned long flags;
1038 dma_addr_t offset;
1039
1040 ioc = GET_IOC(dev);
1041 ASSERT(ioc);
1042
1043#ifdef ALLOW_IOV_BYPASS
1044 if (likely((iova & ioc->imask) != ioc->ibase)) {
1045 /*
1046 ** Address does not fall w/in IOVA, must be bypassing
1047 */
309df0c5
AK
1048 DBG_BYPASS("sba_unmap_single_atttrs() bypass addr: 0x%lx\n",
1049 iova);
1da177e4
LT
1050
1051#ifdef ENABLE_MARK_CLEAN
1052 if (dir == DMA_FROM_DEVICE) {
1053 mark_clean(phys_to_virt(iova), size);
1054 }
1055#endif
1056 return;
1057 }
1058#endif
1059 offset = iova & ~iovp_mask;
1060
d4ed8084 1061 DBG_RUN("%s() iovp 0x%lx/%x\n", __func__, (long) iova, size);
1da177e4
LT
1062
1063 iova ^= offset; /* clear offset bits */
1064 size += offset;
1065 size = ROUNDUP(size, iovp_size);
1066
5f6602a1
AW
1067#ifdef ENABLE_MARK_CLEAN
1068 if (dir == DMA_FROM_DEVICE)
1069 sba_mark_clean(ioc, iova, size);
1070#endif
1da177e4
LT
1071
1072#if DELAYED_RESOURCE_CNT > 0
1073 spin_lock_irqsave(&ioc->saved_lock, flags);
1074 d = &(ioc->saved[ioc->saved_cnt]);
1075 d->iova = iova;
1076 d->size = size;
1077 if (unlikely(++(ioc->saved_cnt) >= DELAYED_RESOURCE_CNT)) {
1078 int cnt = ioc->saved_cnt;
1079 spin_lock(&ioc->res_lock);
1080 while (cnt--) {
1081 sba_mark_invalid(ioc, d->iova, d->size);
1082 sba_free_range(ioc, d->iova, d->size);
1083 d--;
1084 }
1085 ioc->saved_cnt = 0;
1086 READ_REG(ioc->ioc_hpa+IOC_PCOM); /* flush purges */
1087 spin_unlock(&ioc->res_lock);
1088 }
1089 spin_unlock_irqrestore(&ioc->saved_lock, flags);
1090#else /* DELAYED_RESOURCE_CNT == 0 */
1091 spin_lock_irqsave(&ioc->res_lock, flags);
1092 sba_mark_invalid(ioc, iova, size);
1093 sba_free_range(ioc, iova, size);
1094 READ_REG(ioc->ioc_hpa+IOC_PCOM); /* flush purges */
1095 spin_unlock_irqrestore(&ioc->res_lock, flags);
1096#endif /* DELAYED_RESOURCE_CNT == 0 */
1da177e4 1097}
309df0c5 1098EXPORT_SYMBOL(sba_unmap_single_attrs);
1da177e4
LT
1099
1100/**
1101 * sba_alloc_coherent - allocate/map shared mem for DMA
1102 * @dev: instance of PCI owned by the driver that's asking.
1103 * @size: number of bytes mapped in driver buffer.
1104 * @dma_handle: IOVA of new buffer.
1105 *
1106 * See Documentation/DMA-mapping.txt
1107 */
1108void *
06a54497 1109sba_alloc_coherent (struct device *dev, size_t size, dma_addr_t *dma_handle, gfp_t flags)
1da177e4
LT
1110{
1111 struct ioc *ioc;
1112 void *addr;
1113
1114 ioc = GET_IOC(dev);
1115 ASSERT(ioc);
1116
1117#ifdef CONFIG_NUMA
1118 {
1119 struct page *page;
1120 page = alloc_pages_node(ioc->node == MAX_NUMNODES ?
1121 numa_node_id() : ioc->node, flags,
1122 get_order(size));
1123
1124 if (unlikely(!page))
1125 return NULL;
1126
1127 addr = page_address(page);
1128 }
1129#else
1130 addr = (void *) __get_free_pages(flags, get_order(size));
1131#endif
1132 if (unlikely(!addr))
1133 return NULL;
1134
1135 memset(addr, 0, size);
1136 *dma_handle = virt_to_phys(addr);
1137
1138#ifdef ALLOW_IOV_BYPASS
1139 ASSERT(dev->coherent_dma_mask);
1140 /*
1141 ** Check if the PCI device can DMA to ptr... if so, just return ptr
1142 */
1143 if (likely((*dma_handle & ~dev->coherent_dma_mask) == 0)) {
1144 DBG_BYPASS("sba_alloc_coherent() bypass mask/addr: 0x%lx/0x%lx\n",
1145 dev->coherent_dma_mask, *dma_handle);
1146
1147 return addr;
1148 }
1149#endif
1150
1151 /*
1152 * If device can't bypass or bypass is disabled, pass the 32bit fake
1153 * device to map single to get an iova mapping.
1154 */
309df0c5
AK
1155 *dma_handle = sba_map_single_attrs(&ioc->sac_only_dev->dev, addr,
1156 size, 0, NULL);
1da177e4
LT
1157
1158 return addr;
1159}
1160
1161
1162/**
1163 * sba_free_coherent - free/unmap shared mem for DMA
1164 * @dev: instance of PCI owned by the driver that's asking.
1165 * @size: number of bytes mapped in driver buffer.
1166 * @vaddr: virtual address IOVA of "consistent" buffer.
1167 * @dma_handler: IO virtual address of "consistent" buffer.
1168 *
1169 * See Documentation/DMA-mapping.txt
1170 */
1171void sba_free_coherent (struct device *dev, size_t size, void *vaddr, dma_addr_t dma_handle)
1172{
309df0c5 1173 sba_unmap_single_attrs(dev, dma_handle, size, 0, NULL);
1da177e4
LT
1174 free_pages((unsigned long) vaddr, get_order(size));
1175}
1176
1177
1178/*
1179** Since 0 is a valid pdir_base index value, can't use that
1180** to determine if a value is valid or not. Use a flag to indicate
1181** the SG list entry contains a valid pdir index.
1182*/
1183#define PIDE_FLAG 0x1UL
1184
1185#ifdef DEBUG_LARGE_SG_ENTRIES
1186int dump_run_sg = 0;
1187#endif
1188
1189
1190/**
1191 * sba_fill_pdir - write allocated SG entries into IO PDIR
1192 * @ioc: IO MMU structure which owns the pdir we are interested in.
1193 * @startsg: list of IOVA/size pairs
1194 * @nents: number of entries in startsg list
1195 *
1196 * Take preprocessed SG list and write corresponding entries
1197 * in the IO PDIR.
1198 */
1199
1200static SBA_INLINE int
1201sba_fill_pdir(
1202 struct ioc *ioc,
1203 struct scatterlist *startsg,
1204 int nents)
1205{
1206 struct scatterlist *dma_sg = startsg; /* pointer to current DMA */
1207 int n_mappings = 0;
1208 u64 *pdirp = NULL;
1209 unsigned long dma_offset = 0;
1210
1da177e4
LT
1211 while (nents-- > 0) {
1212 int cnt = startsg->dma_length;
1213 startsg->dma_length = 0;
1214
1215#ifdef DEBUG_LARGE_SG_ENTRIES
1216 if (dump_run_sg)
1217 printk(" %2d : %08lx/%05x %p\n",
1218 nents, startsg->dma_address, cnt,
1219 sba_sg_address(startsg));
1220#else
1221 DBG_RUN_SG(" %d : %08lx/%05x %p\n",
1222 nents, startsg->dma_address, cnt,
1223 sba_sg_address(startsg));
1224#endif
1225 /*
1226 ** Look for the start of a new DMA stream
1227 */
1228 if (startsg->dma_address & PIDE_FLAG) {
1229 u32 pide = startsg->dma_address & ~PIDE_FLAG;
1230 dma_offset = (unsigned long) pide & ~iovp_mask;
1231 startsg->dma_address = 0;
bdb02504
FT
1232 if (n_mappings)
1233 dma_sg = sg_next(dma_sg);
1da177e4
LT
1234 dma_sg->dma_address = pide | ioc->ibase;
1235 pdirp = &(ioc->pdir_base[pide >> iovp_shift]);
1236 n_mappings++;
1237 }
1238
1239 /*
1240 ** Look for a VCONTIG chunk
1241 */
1242 if (cnt) {
1243 unsigned long vaddr = (unsigned long) sba_sg_address(startsg);
1244 ASSERT(pdirp);
1245
1246 /* Since multiple Vcontig blocks could make up
1247 ** one DMA stream, *add* cnt to dma_len.
1248 */
1249 dma_sg->dma_length += cnt;
1250 cnt += dma_offset;
1251 dma_offset=0; /* only want offset on first chunk */
1252 cnt = ROUNDUP(cnt, iovp_size);
1253 do {
1254 sba_io_pdir_entry(pdirp, vaddr);
1255 vaddr += iovp_size;
1256 cnt -= iovp_size;
1257 pdirp++;
1258 } while (cnt > 0);
1259 }
9b6eccfc 1260 startsg = sg_next(startsg);
1da177e4
LT
1261 }
1262 /* force pdir update */
1263 wmb();
1264
1265#ifdef DEBUG_LARGE_SG_ENTRIES
1266 dump_run_sg = 0;
1267#endif
1268 return(n_mappings);
1269}
1270
1271
1272/*
1273** Two address ranges are DMA contiguous *iff* "end of prev" and
1274** "start of next" are both on an IOV page boundary.
1275**
1276** (shift left is a quick trick to mask off upper bits)
1277*/
1278#define DMA_CONTIG(__X, __Y) \
1279 (((((unsigned long) __X) | ((unsigned long) __Y)) << (BITS_PER_LONG - iovp_shift)) == 0UL)
1280
1281
1282/**
1283 * sba_coalesce_chunks - preprocess the SG list
1284 * @ioc: IO MMU structure which owns the pdir we are interested in.
1285 * @startsg: list of IOVA/size pairs
1286 * @nents: number of entries in startsg list
1287 *
1288 * First pass is to walk the SG list and determine where the breaks are
1289 * in the DMA stream. Allocates PDIR entries but does not fill them.
1290 * Returns the number of DMA chunks.
1291 *
1292 * Doing the fill separate from the coalescing/allocation keeps the
1293 * code simpler. Future enhancement could make one pass through
1294 * the sglist do both.
1295 */
1296static SBA_INLINE int
a031bbcb 1297sba_coalesce_chunks(struct ioc *ioc, struct device *dev,
1da177e4
LT
1298 struct scatterlist *startsg,
1299 int nents)
1300{
1301 struct scatterlist *vcontig_sg; /* VCONTIG chunk head */
1302 unsigned long vcontig_len; /* len of VCONTIG chunk */
1303 unsigned long vcontig_end;
1304 struct scatterlist *dma_sg; /* next DMA stream head */
1305 unsigned long dma_offset, dma_len; /* start/len of DMA stream */
1306 int n_mappings = 0;
a031bbcb 1307 unsigned int max_seg_size = dma_get_max_seg_size(dev);
1da177e4
LT
1308
1309 while (nents > 0) {
1310 unsigned long vaddr = (unsigned long) sba_sg_address(startsg);
1311
1312 /*
1313 ** Prepare for first/next DMA stream
1314 */
1315 dma_sg = vcontig_sg = startsg;
1316 dma_len = vcontig_len = vcontig_end = startsg->length;
1317 vcontig_end += vaddr;
1318 dma_offset = vaddr & ~iovp_mask;
1319
1320 /* PARANOID: clear entries */
1321 startsg->dma_address = startsg->dma_length = 0;
1322
1323 /*
1324 ** This loop terminates one iteration "early" since
1325 ** it's always looking one "ahead".
1326 */
1327 while (--nents > 0) {
1328 unsigned long vaddr; /* tmp */
1329
9b6eccfc 1330 startsg = sg_next(startsg);
1da177e4
LT
1331
1332 /* PARANOID */
1333 startsg->dma_address = startsg->dma_length = 0;
1334
1335 /* catch brokenness in SCSI layer */
1336 ASSERT(startsg->length <= DMA_CHUNK_SIZE);
1337
1338 /*
1339 ** First make sure current dma stream won't
1340 ** exceed DMA_CHUNK_SIZE if we coalesce the
1341 ** next entry.
1342 */
1343 if (((dma_len + dma_offset + startsg->length + ~iovp_mask) & iovp_mask)
1344 > DMA_CHUNK_SIZE)
1345 break;
1346
a031bbcb
FT
1347 if (dma_len + startsg->length > max_seg_size)
1348 break;
1349
1da177e4
LT
1350 /*
1351 ** Then look for virtually contiguous blocks.
1352 **
1353 ** append the next transaction?
1354 */
1355 vaddr = (unsigned long) sba_sg_address(startsg);
1356 if (vcontig_end == vaddr)
1357 {
1358 vcontig_len += startsg->length;
1359 vcontig_end += startsg->length;
1360 dma_len += startsg->length;
1361 continue;
1362 }
1363
1364#ifdef DEBUG_LARGE_SG_ENTRIES
1365 dump_run_sg = (vcontig_len > iovp_size);
1366#endif
1367
1368 /*
1369 ** Not virtually contigous.
1370 ** Terminate prev chunk.
1371 ** Start a new chunk.
1372 **
1373 ** Once we start a new VCONTIG chunk, dma_offset
1374 ** can't change. And we need the offset from the first
1375 ** chunk - not the last one. Ergo Successive chunks
1376 ** must start on page boundaries and dove tail
1377 ** with it's predecessor.
1378 */
1379 vcontig_sg->dma_length = vcontig_len;
1380
1381 vcontig_sg = startsg;
1382 vcontig_len = startsg->length;
1383
1384 /*
1385 ** 3) do the entries end/start on page boundaries?
1386 ** Don't update vcontig_end until we've checked.
1387 */
1388 if (DMA_CONTIG(vcontig_end, vaddr))
1389 {
1390 vcontig_end = vcontig_len + vaddr;
1391 dma_len += vcontig_len;
1392 continue;
1393 } else {
1394 break;
1395 }
1396 }
1397
1398 /*
1399 ** End of DMA Stream
1400 ** Terminate last VCONTIG block.
1401 ** Allocate space for DMA stream.
1402 */
1403 vcontig_sg->dma_length = vcontig_len;
1404 dma_len = (dma_len + dma_offset + ~iovp_mask) & iovp_mask;
1405 ASSERT(dma_len <= DMA_CHUNK_SIZE);
1406 dma_sg->dma_address = (dma_addr_t) (PIDE_FLAG
b34eb53c 1407 | (sba_alloc_range(ioc, dev, dma_len) << iovp_shift)
1da177e4
LT
1408 | dma_offset);
1409 n_mappings++;
1410 }
1411
1412 return n_mappings;
1413}
1414
1415
1416/**
1417 * sba_map_sg - map Scatter/Gather list
1418 * @dev: instance of PCI owned by the driver that's asking.
1419 * @sglist: array of buffer/length pairs
1420 * @nents: number of entries in list
1421 * @dir: R/W or both.
309df0c5 1422 * @attrs: optional dma attributes
1da177e4
LT
1423 *
1424 * See Documentation/DMA-mapping.txt
1425 */
309df0c5
AK
1426int sba_map_sg_attrs(struct device *dev, struct scatterlist *sglist, int nents,
1427 int dir, struct dma_attrs *attrs)
1da177e4
LT
1428{
1429 struct ioc *ioc;
1430 int coalesced, filled = 0;
1431#ifdef ASSERT_PDIR_SANITY
1432 unsigned long flags;
1433#endif
1434#ifdef ALLOW_IOV_BYPASS_SG
1435 struct scatterlist *sg;
1436#endif
1437
d4ed8084 1438 DBG_RUN_SG("%s() START %d entries\n", __func__, nents);
1da177e4
LT
1439 ioc = GET_IOC(dev);
1440 ASSERT(ioc);
1441
1442#ifdef ALLOW_IOV_BYPASS_SG
1443 ASSERT(to_pci_dev(dev)->dma_mask);
1444 if (likely((ioc->dma_mask & ~to_pci_dev(dev)->dma_mask) == 0)) {
9b6eccfc 1445 for_each_sg(sglist, sg, nents, filled) {
1da177e4
LT
1446 sg->dma_length = sg->length;
1447 sg->dma_address = virt_to_phys(sba_sg_address(sg));
1448 }
1449 return filled;
1450 }
1451#endif
1452 /* Fast path single entry scatterlists. */
1453 if (nents == 1) {
1454 sglist->dma_length = sglist->length;
309df0c5 1455 sglist->dma_address = sba_map_single_attrs(dev, sba_sg_address(sglist), sglist->length, dir, attrs);
1da177e4
LT
1456 return 1;
1457 }
1458
1459#ifdef ASSERT_PDIR_SANITY
1460 spin_lock_irqsave(&ioc->res_lock, flags);
309df0c5 1461 if (sba_check_pdir(ioc,"Check before sba_map_sg_attrs()"))
1da177e4
LT
1462 {
1463 sba_dump_sg(ioc, sglist, nents);
309df0c5 1464 panic("Check before sba_map_sg_attrs()");
1da177e4
LT
1465 }
1466 spin_unlock_irqrestore(&ioc->res_lock, flags);
1467#endif
1468
1469 prefetch(ioc->res_hint);
1470
1471 /*
1472 ** First coalesce the chunks and allocate I/O pdir space
1473 **
1474 ** If this is one DMA stream, we can properly map using the
1475 ** correct virtual address associated with each DMA page.
1476 ** w/o this association, we wouldn't have coherent DMA!
1477 ** Access to the virtual address is what forces a two pass algorithm.
1478 */
a031bbcb 1479 coalesced = sba_coalesce_chunks(ioc, dev, sglist, nents);
1da177e4
LT
1480
1481 /*
1482 ** Program the I/O Pdir
1483 **
1484 ** map the virtual addresses to the I/O Pdir
1485 ** o dma_address will contain the pdir index
1486 ** o dma_len will contain the number of bytes to map
1487 ** o address contains the virtual address.
1488 */
1489 filled = sba_fill_pdir(ioc, sglist, nents);
1490
1491#ifdef ASSERT_PDIR_SANITY
1492 spin_lock_irqsave(&ioc->res_lock, flags);
309df0c5 1493 if (sba_check_pdir(ioc,"Check after sba_map_sg_attrs()"))
1da177e4
LT
1494 {
1495 sba_dump_sg(ioc, sglist, nents);
309df0c5 1496 panic("Check after sba_map_sg_attrs()\n");
1da177e4
LT
1497 }
1498 spin_unlock_irqrestore(&ioc->res_lock, flags);
1499#endif
1500
1501 ASSERT(coalesced == filled);
d4ed8084 1502 DBG_RUN_SG("%s() DONE %d mappings\n", __func__, filled);
1da177e4
LT
1503
1504 return filled;
1505}
309df0c5 1506EXPORT_SYMBOL(sba_map_sg_attrs);
1da177e4
LT
1507
1508/**
309df0c5 1509 * sba_unmap_sg_attrs - unmap Scatter/Gather list
1da177e4
LT
1510 * @dev: instance of PCI owned by the driver that's asking.
1511 * @sglist: array of buffer/length pairs
1512 * @nents: number of entries in list
1513 * @dir: R/W or both.
309df0c5 1514 * @attrs: optional dma attributes
1da177e4
LT
1515 *
1516 * See Documentation/DMA-mapping.txt
1517 */
309df0c5
AK
1518void sba_unmap_sg_attrs(struct device *dev, struct scatterlist *sglist,
1519 int nents, int dir, struct dma_attrs *attrs)
1da177e4
LT
1520{
1521#ifdef ASSERT_PDIR_SANITY
1522 struct ioc *ioc;
1523 unsigned long flags;
1524#endif
1525
1526 DBG_RUN_SG("%s() START %d entries, %p,%x\n",
d4ed8084 1527 __func__, nents, sba_sg_address(sglist), sglist->length);
1da177e4
LT
1528
1529#ifdef ASSERT_PDIR_SANITY
1530 ioc = GET_IOC(dev);
1531 ASSERT(ioc);
1532
1533 spin_lock_irqsave(&ioc->res_lock, flags);
309df0c5 1534 sba_check_pdir(ioc,"Check before sba_unmap_sg_attrs()");
1da177e4
LT
1535 spin_unlock_irqrestore(&ioc->res_lock, flags);
1536#endif
1537
1538 while (nents && sglist->dma_length) {
1539
309df0c5
AK
1540 sba_unmap_single_attrs(dev, sglist->dma_address,
1541 sglist->dma_length, dir, attrs);
9b6eccfc 1542 sglist = sg_next(sglist);
1da177e4
LT
1543 nents--;
1544 }
1545
d4ed8084 1546 DBG_RUN_SG("%s() DONE (nents %d)\n", __func__, nents);
1da177e4
LT
1547
1548#ifdef ASSERT_PDIR_SANITY
1549 spin_lock_irqsave(&ioc->res_lock, flags);
309df0c5 1550 sba_check_pdir(ioc,"Check after sba_unmap_sg_attrs()");
1da177e4
LT
1551 spin_unlock_irqrestore(&ioc->res_lock, flags);
1552#endif
1553
1554}
309df0c5 1555EXPORT_SYMBOL(sba_unmap_sg_attrs);
1da177e4
LT
1556
1557/**************************************************************
1558*
1559* Initialization and claim
1560*
1561***************************************************************/
1562
1563static void __init
1564ioc_iova_init(struct ioc *ioc)
1565{
1566 int tcnfg;
1567 int agp_found = 0;
1568 struct pci_dev *device = NULL;
1569#ifdef FULL_VALID_PDIR
1570 unsigned long index;
1571#endif
1572
1573 /*
1574 ** Firmware programs the base and size of a "safe IOVA space"
1575 ** (one that doesn't overlap memory or LMMIO space) in the
1576 ** IBASE and IMASK registers.
1577 */
1578 ioc->ibase = READ_REG(ioc->ioc_hpa + IOC_IBASE) & ~0x1UL;
1579 ioc->imask = READ_REG(ioc->ioc_hpa + IOC_IMASK) | 0xFFFFFFFF00000000UL;
1580
1581 ioc->iov_size = ~ioc->imask + 1;
1582
1583 DBG_INIT("%s() hpa %p IOV base 0x%lx mask 0x%lx (%dMB)\n",
d4ed8084 1584 __func__, ioc->ioc_hpa, ioc->ibase, ioc->imask,
1da177e4
LT
1585 ioc->iov_size >> 20);
1586
1587 switch (iovp_size) {
1588 case 4*1024: tcnfg = 0; break;
1589 case 8*1024: tcnfg = 1; break;
1590 case 16*1024: tcnfg = 2; break;
1591 case 64*1024: tcnfg = 3; break;
1592 default:
1593 panic(PFX "Unsupported IOTLB page size %ldK",
1594 iovp_size >> 10);
1595 break;
1596 }
1597 WRITE_REG(tcnfg, ioc->ioc_hpa + IOC_TCNFG);
1598
1599 ioc->pdir_size = (ioc->iov_size / iovp_size) * PDIR_ENTRY_SIZE;
1600 ioc->pdir_base = (void *) __get_free_pages(GFP_KERNEL,
1601 get_order(ioc->pdir_size));
1602 if (!ioc->pdir_base)
1603 panic(PFX "Couldn't allocate I/O Page Table\n");
1604
1605 memset(ioc->pdir_base, 0, ioc->pdir_size);
1606
d4ed8084 1607 DBG_INIT("%s() IOV page size %ldK pdir %p size %x\n", __func__,
1da177e4
LT
1608 iovp_size >> 10, ioc->pdir_base, ioc->pdir_size);
1609
1610 ASSERT(ALIGN((unsigned long) ioc->pdir_base, 4*1024) == (unsigned long) ioc->pdir_base);
1611 WRITE_REG(virt_to_phys(ioc->pdir_base), ioc->ioc_hpa + IOC_PDIR_BASE);
1612
1613 /*
1614 ** If an AGP device is present, only use half of the IOV space
1615 ** for PCI DMA. Unfortunately we can't know ahead of time
1616 ** whether GART support will actually be used, for now we
1617 ** can just key on an AGP device found in the system.
1618 ** We program the next pdir index after we stop w/ a key for
1619 ** the GART code to handshake on.
1620 */
1621 for_each_pci_dev(device)
1622 agp_found |= pci_find_capability(device, PCI_CAP_ID_AGP);
1623
1624 if (agp_found && reserve_sba_gart) {
1625 printk(KERN_INFO PFX "reserving %dMb of IOVA space at 0x%lx for agpgart\n",
1626 ioc->iov_size/2 >> 20, ioc->ibase + ioc->iov_size/2);
1627 ioc->pdir_size /= 2;
1628 ((u64 *)ioc->pdir_base)[PDIR_INDEX(ioc->iov_size/2)] = ZX1_SBA_IOMMU_COOKIE;
1629 }
1630#ifdef FULL_VALID_PDIR
1631 /*
1632 ** Check to see if the spill page has been allocated, we don't need more than
1633 ** one across multiple SBAs.
1634 */
1635 if (!prefetch_spill_page) {
1636 char *spill_poison = "SBAIOMMU POISON";
1637 int poison_size = 16;
1638 void *poison_addr, *addr;
1639
1640 addr = (void *)__get_free_pages(GFP_KERNEL, get_order(iovp_size));
1641 if (!addr)
1642 panic(PFX "Couldn't allocate PDIR spill page\n");
1643
1644 poison_addr = addr;
1645 for ( ; (u64) poison_addr < addr + iovp_size; poison_addr += poison_size)
1646 memcpy(poison_addr, spill_poison, poison_size);
1647
1648 prefetch_spill_page = virt_to_phys(addr);
1649
d4ed8084 1650 DBG_INIT("%s() prefetch spill addr: 0x%lx\n", __func__, prefetch_spill_page);
1da177e4
LT
1651 }
1652 /*
1653 ** Set all the PDIR entries valid w/ the spill page as the target
1654 */
1655 for (index = 0 ; index < (ioc->pdir_size / PDIR_ENTRY_SIZE) ; index++)
1656 ((u64 *)ioc->pdir_base)[index] = (0x80000000000000FF | prefetch_spill_page);
1657#endif
1658
1659 /* Clear I/O TLB of any possible entries */
1660 WRITE_REG(ioc->ibase | (get_iovp_order(ioc->iov_size) + iovp_shift), ioc->ioc_hpa + IOC_PCOM);
1661 READ_REG(ioc->ioc_hpa + IOC_PCOM);
1662
1663 /* Enable IOVA translation */
1664 WRITE_REG(ioc->ibase | 1, ioc->ioc_hpa + IOC_IBASE);
1665 READ_REG(ioc->ioc_hpa + IOC_IBASE);
1666}
1667
1668static void __init
1669ioc_resource_init(struct ioc *ioc)
1670{
1671 spin_lock_init(&ioc->res_lock);
1672#if DELAYED_RESOURCE_CNT > 0
1673 spin_lock_init(&ioc->saved_lock);
1674#endif
1675
1676 /* resource map size dictated by pdir_size */
1677 ioc->res_size = ioc->pdir_size / PDIR_ENTRY_SIZE; /* entries */
1678 ioc->res_size >>= 3; /* convert bit count to byte count */
d4ed8084 1679 DBG_INIT("%s() res_size 0x%x\n", __func__, ioc->res_size);
1da177e4
LT
1680
1681 ioc->res_map = (char *) __get_free_pages(GFP_KERNEL,
1682 get_order(ioc->res_size));
1683 if (!ioc->res_map)
1684 panic(PFX "Couldn't allocate resource map\n");
1685
1686 memset(ioc->res_map, 0, ioc->res_size);
1687 /* next available IOVP - circular search */
1688 ioc->res_hint = (unsigned long *) ioc->res_map;
1689
1690#ifdef ASSERT_PDIR_SANITY
1691 /* Mark first bit busy - ie no IOVA 0 */
1692 ioc->res_map[0] = 0x1;
1693 ioc->pdir_base[0] = 0x8000000000000000ULL | ZX1_SBA_IOMMU_COOKIE;
1694#endif
1695#ifdef FULL_VALID_PDIR
1696 /* Mark the last resource used so we don't prefetch beyond IOVA space */
1697 ioc->res_map[ioc->res_size - 1] |= 0x80UL; /* res_map is chars */
1698 ioc->pdir_base[(ioc->pdir_size / PDIR_ENTRY_SIZE) - 1] = (0x80000000000000FF
1699 | prefetch_spill_page);
1700#endif
1701
d4ed8084 1702 DBG_INIT("%s() res_map %x %p\n", __func__,
1da177e4
LT
1703 ioc->res_size, (void *) ioc->res_map);
1704}
1705
1706static void __init
1707ioc_sac_init(struct ioc *ioc)
1708{
1709 struct pci_dev *sac = NULL;
1710 struct pci_controller *controller = NULL;
1711
1712 /*
1713 * pci_alloc_coherent() must return a DMA address which is
1714 * SAC (single address cycle) addressable, so allocate a
1715 * pseudo-device to enforce that.
1716 */
52fd9108 1717 sac = kzalloc(sizeof(*sac), GFP_KERNEL);
1da177e4
LT
1718 if (!sac)
1719 panic(PFX "Couldn't allocate struct pci_dev");
1da177e4 1720
52fd9108 1721 controller = kzalloc(sizeof(*controller), GFP_KERNEL);
1da177e4
LT
1722 if (!controller)
1723 panic(PFX "Couldn't allocate struct pci_controller");
1da177e4
LT
1724
1725 controller->iommu = ioc;
1726 sac->sysdata = controller;
1727 sac->dma_mask = 0xFFFFFFFFUL;
1728#ifdef CONFIG_PCI
1729 sac->dev.bus = &pci_bus_type;
1730#endif
1731 ioc->sac_only_dev = sac;
1732}
1733
1734static void __init
1735ioc_zx1_init(struct ioc *ioc)
1736{
1737 unsigned long rope_config;
1738 unsigned int i;
1739
1740 if (ioc->rev < 0x20)
1741 panic(PFX "IOC 2.0 or later required for IOMMU support\n");
1742
1743 /* 38 bit memory controller + extra bit for range displaced by MMIO */
1744 ioc->dma_mask = (0x1UL << 39) - 1;
1745
1746 /*
1747 ** Clear ROPE(N)_CONFIG AO bit.
1748 ** Disables "NT Ordering" (~= !"Relaxed Ordering")
1749 ** Overrides bit 1 in DMA Hint Sets.
1750 ** Improves netperf UDP_STREAM by ~10% for tg3 on bcm5701.
1751 */
1752 for (i=0; i<(8*8); i+=8) {
1753 rope_config = READ_REG(ioc->ioc_hpa + IOC_ROPE0_CFG + i);
1754 rope_config &= ~IOC_ROPE_AO;
1755 WRITE_REG(rope_config, ioc->ioc_hpa + IOC_ROPE0_CFG + i);
1756 }
1757}
1758
1759typedef void (initfunc)(struct ioc *);
1760
1761struct ioc_iommu {
1762 u32 func_id;
1763 char *name;
1764 initfunc *init;
1765};
1766
1767static struct ioc_iommu ioc_iommu_info[] __initdata = {
1768 { ZX1_IOC_ID, "zx1", ioc_zx1_init },
1769 { ZX2_IOC_ID, "zx2", NULL },
1770 { SX1000_IOC_ID, "sx1000", NULL },
e15da401 1771 { SX2000_IOC_ID, "sx2000", NULL },
1da177e4
LT
1772};
1773
1774static struct ioc * __init
1775ioc_init(u64 hpa, void *handle)
1776{
1777 struct ioc *ioc;
1778 struct ioc_iommu *info;
1779
52fd9108 1780 ioc = kzalloc(sizeof(*ioc), GFP_KERNEL);
1da177e4
LT
1781 if (!ioc)
1782 return NULL;
1783
1da177e4
LT
1784 ioc->next = ioc_list;
1785 ioc_list = ioc;
1786
1787 ioc->handle = handle;
1788 ioc->ioc_hpa = ioremap(hpa, 0x1000);
1789
1790 ioc->func_id = READ_REG(ioc->ioc_hpa + IOC_FUNC_ID);
1791 ioc->rev = READ_REG(ioc->ioc_hpa + IOC_FCLASS) & 0xFFUL;
1792 ioc->dma_mask = 0xFFFFFFFFFFFFFFFFUL; /* conservative */
1793
1794 for (info = ioc_iommu_info; info < ioc_iommu_info + ARRAY_SIZE(ioc_iommu_info); info++) {
1795 if (ioc->func_id == info->func_id) {
1796 ioc->name = info->name;
1797 if (info->init)
1798 (info->init)(ioc);
1799 }
1800 }
1801
1802 iovp_size = (1 << iovp_shift);
1803 iovp_mask = ~(iovp_size - 1);
1804
d4ed8084 1805 DBG_INIT("%s: PAGE_SIZE %ldK, iovp_size %ldK\n", __func__,
1da177e4
LT
1806 PAGE_SIZE >> 10, iovp_size >> 10);
1807
1808 if (!ioc->name) {
1809 ioc->name = kmalloc(24, GFP_KERNEL);
1810 if (ioc->name)
1811 sprintf((char *) ioc->name, "Unknown (%04x:%04x)",
1812 ioc->func_id & 0xFFFF, (ioc->func_id >> 16) & 0xFFFF);
1813 else
1814 ioc->name = "Unknown";
1815 }
1816
1817 ioc_iova_init(ioc);
1818 ioc_resource_init(ioc);
1819 ioc_sac_init(ioc);
1820
1821 if ((long) ~iovp_mask > (long) ia64_max_iommu_merge_mask)
1822 ia64_max_iommu_merge_mask = ~iovp_mask;
1823
1824 printk(KERN_INFO PFX
1825 "%s %d.%d HPA 0x%lx IOVA space %dMb at 0x%lx\n",
1826 ioc->name, (ioc->rev >> 4) & 0xF, ioc->rev & 0xF,
1827 hpa, ioc->iov_size >> 20, ioc->ibase);
1828
1829 return ioc;
1830}
1831
1832
1833
1834/**************************************************************************
1835**
1836** SBA initialization code (HW and SW)
1837**
1838** o identify SBA chip itself
1839** o FIXME: initialize DMA hints for reasonable defaults
1840**
1841**************************************************************************/
1842
1843#ifdef CONFIG_PROC_FS
1844static void *
1845ioc_start(struct seq_file *s, loff_t *pos)
1846{
1847 struct ioc *ioc;
1848 loff_t n = *pos;
1849
1850 for (ioc = ioc_list; ioc; ioc = ioc->next)
1851 if (!n--)
1852 return ioc;
1853
1854 return NULL;
1855}
1856
1857static void *
1858ioc_next(struct seq_file *s, void *v, loff_t *pos)
1859{
1860 struct ioc *ioc = v;
1861
1862 ++*pos;
1863 return ioc->next;
1864}
1865
1866static void
1867ioc_stop(struct seq_file *s, void *v)
1868{
1869}
1870
1871static int
1872ioc_show(struct seq_file *s, void *v)
1873{
1874 struct ioc *ioc = v;
1875 unsigned long *res_ptr = (unsigned long *)ioc->res_map;
1876 int i, used = 0;
1877
1878 seq_printf(s, "Hewlett Packard %s IOC rev %d.%d\n",
1879 ioc->name, ((ioc->rev >> 4) & 0xF), (ioc->rev & 0xF));
1880#ifdef CONFIG_NUMA
1881 if (ioc->node != MAX_NUMNODES)
1882 seq_printf(s, "NUMA node : %d\n", ioc->node);
1883#endif
1884 seq_printf(s, "IOVA size : %ld MB\n", ((ioc->pdir_size >> 3) * iovp_size)/(1024*1024));
1885 seq_printf(s, "IOVA page size : %ld kb\n", iovp_size/1024);
1886
1887 for (i = 0; i < (ioc->res_size / sizeof(unsigned long)); ++i, ++res_ptr)
1888 used += hweight64(*res_ptr);
1889
1890 seq_printf(s, "PDIR size : %d entries\n", ioc->pdir_size >> 3);
1891 seq_printf(s, "PDIR used : %d entries\n", used);
1892
1893#ifdef PDIR_SEARCH_TIMING
1894 {
1895 unsigned long i = 0, avg = 0, min, max;
1896 min = max = ioc->avg_search[0];
1897 for (i = 0; i < SBA_SEARCH_SAMPLE; i++) {
1898 avg += ioc->avg_search[i];
1899 if (ioc->avg_search[i] > max) max = ioc->avg_search[i];
1900 if (ioc->avg_search[i] < min) min = ioc->avg_search[i];
1901 }
1902 avg /= SBA_SEARCH_SAMPLE;
1903 seq_printf(s, "Bitmap search : %ld/%ld/%ld (min/avg/max CPU Cycles/IOVA page)\n",
1904 min, avg, max);
1905 }
1906#endif
1907#ifndef ALLOW_IOV_BYPASS
1908 seq_printf(s, "IOVA bypass disabled\n");
1909#endif
1910 return 0;
1911}
1912
a23fe55e 1913static const struct seq_operations ioc_seq_ops = {
1da177e4
LT
1914 .start = ioc_start,
1915 .next = ioc_next,
1916 .stop = ioc_stop,
1917 .show = ioc_show
1918};
1919
1920static int
1921ioc_open(struct inode *inode, struct file *file)
1922{
1923 return seq_open(file, &ioc_seq_ops);
1924}
1925
5dfe4c96 1926static const struct file_operations ioc_fops = {
1da177e4
LT
1927 .open = ioc_open,
1928 .read = seq_read,
1929 .llseek = seq_lseek,
1930 .release = seq_release
1931};
1932
1933static void __init
1934ioc_proc_init(void)
1935{
e2363768 1936 struct proc_dir_entry *dir;
1da177e4
LT
1937
1938 dir = proc_mkdir("bus/mckinley", NULL);
1939 if (!dir)
1940 return;
1941
e2363768 1942 proc_create(ioc_list->name, 0, dir, &ioc_fops);
1da177e4
LT
1943}
1944#endif
1945
1946static void
1947sba_connect_bus(struct pci_bus *bus)
1948{
1949 acpi_handle handle, parent;
1950 acpi_status status;
1951 struct ioc *ioc;
1952
1953 if (!PCI_CONTROLLER(bus))
1954 panic(PFX "no sysdata on bus %d!\n", bus->number);
1955
1956 if (PCI_CONTROLLER(bus)->iommu)
1957 return;
1958
1959 handle = PCI_CONTROLLER(bus)->acpi_handle;
1960 if (!handle)
1961 return;
1962
1963 /*
1964 * The IOC scope encloses PCI root bridges in the ACPI
1965 * namespace, so work our way out until we find an IOC we
1966 * claimed previously.
1967 */
1968 do {
1969 for (ioc = ioc_list; ioc; ioc = ioc->next)
1970 if (ioc->handle == handle) {
1971 PCI_CONTROLLER(bus)->iommu = ioc;
1972 return;
1973 }
1974
1975 status = acpi_get_parent(handle, &parent);
1976 handle = parent;
1977 } while (ACPI_SUCCESS(status));
1978
1979 printk(KERN_WARNING "No IOC for PCI Bus %04x:%02x in ACPI\n", pci_domain_nr(bus), bus->number);
1980}
1981
1982#ifdef CONFIG_NUMA
1983static void __init
1984sba_map_ioc_to_node(struct ioc *ioc, acpi_handle handle)
1985{
1da177e4 1986 unsigned int node;
bb0fc085 1987 int pxm;
1da177e4
LT
1988
1989 ioc->node = MAX_NUMNODES;
1990
bb0fc085 1991 pxm = acpi_get_pxm(handle);
1da177e4 1992
bb0fc085 1993 if (pxm < 0)
1da177e4
LT
1994 return;
1995
762834e8 1996 node = pxm_to_node(pxm);
1da177e4
LT
1997
1998 if (node >= MAX_NUMNODES || !node_online(node))
1999 return;
2000
2001 ioc->node = node;
2002 return;
2003}
2004#else
2005#define sba_map_ioc_to_node(ioc, handle)
2006#endif
2007
2008static int __init
2009acpi_sba_ioc_add(struct acpi_device *device)
2010{
2011 struct ioc *ioc;
2012 acpi_status status;
2013 u64 hpa, length;
2014 struct acpi_buffer buffer;
2015 struct acpi_device_info *dev_info;
2016
2017 status = hp_acpi_csr_space(device->handle, &hpa, &length);
2018 if (ACPI_FAILURE(status))
2019 return 1;
2020
2021 buffer.length = ACPI_ALLOCATE_LOCAL_BUFFER;
2022 status = acpi_get_object_info(device->handle, &buffer);
2023 if (ACPI_FAILURE(status))
2024 return 1;
2025 dev_info = buffer.pointer;
2026
2027 /*
2028 * For HWP0001, only SBA appears in ACPI namespace. It encloses the PCI
2029 * root bridges, and its CSR space includes the IOC function.
2030 */
2031 if (strncmp("HWP0001", dev_info->hardware_id.value, 7) == 0) {
2032 hpa += ZX1_IOC_OFFSET;
2033 /* zx1 based systems default to kernel page size iommu pages */
2034 if (!iovp_shift)
2035 iovp_shift = min(PAGE_SHIFT, 16);
2036 }
144c87b4 2037 kfree(dev_info);
1da177e4
LT
2038
2039 /*
2040 * default anything not caught above or specified on cmdline to 4k
2041 * iommu page size
2042 */
2043 if (!iovp_shift)
2044 iovp_shift = 12;
2045
2046 ioc = ioc_init(hpa, device->handle);
2047 if (!ioc)
2048 return 1;
2049
2050 /* setup NUMA node association */
2051 sba_map_ioc_to_node(ioc, device->handle);
2052 return 0;
2053}
2054
7091138f
TR
2055static const struct acpi_device_id hp_ioc_iommu_device_ids[] = {
2056 {"HWP0001", 0},
2057 {"HWP0004", 0},
2058 {"", 0},
2059};
1da177e4
LT
2060static struct acpi_driver acpi_sba_ioc_driver = {
2061 .name = "IOC IOMMU Driver",
7091138f 2062 .ids = hp_ioc_iommu_device_ids,
1da177e4
LT
2063 .ops = {
2064 .add = acpi_sba_ioc_add,
2065 },
2066};
2067
4d9b977c
FT
2068extern struct dma_mapping_ops swiotlb_dma_ops;
2069
1da177e4
LT
2070static int __init
2071sba_init(void)
2072{
0b9afede
AW
2073 if (!ia64_platform_is("hpzx1") && !ia64_platform_is("hpzx1_swiotlb"))
2074 return 0;
2075
630bf207 2076#if defined(CONFIG_IA64_GENERIC)
51b58e3e
TL
2077 /* If we are booting a kdump kernel, the sba_iommu will
2078 * cause devices that were not shutdown properly to MCA
2079 * as soon as they are turned back on. Our only option for
2080 * a successful kdump kernel boot is to use the swiotlb.
2081 */
630bf207 2082 if (is_kdump_kernel()) {
4d9b977c 2083 dma_ops = &swiotlb_dma_ops;
51b58e3e
TL
2084 if (swiotlb_late_init_with_default_size(64 * (1<<20)) != 0)
2085 panic("Unable to initialize software I/O TLB:"
2086 " Try machvec=dig boot option");
2087 machvec_init("dig");
2088 return 0;
2089 }
2090#endif
2091
1da177e4 2092 acpi_bus_register_driver(&acpi_sba_ioc_driver);
0b9afede
AW
2093 if (!ioc_list) {
2094#ifdef CONFIG_IA64_GENERIC
0b9afede
AW
2095 /*
2096 * If we didn't find something sba_iommu can claim, we
2097 * need to setup the swiotlb and switch to the dig machvec.
2098 */
4d9b977c 2099 dma_ops = &swiotlb_dma_ops;
0b9afede
AW
2100 if (swiotlb_late_init_with_default_size(64 * (1<<20)) != 0)
2101 panic("Unable to find SBA IOMMU or initialize "
2102 "software I/O TLB: Try machvec=dig boot option");
2103 machvec_init("dig");
2104#else
2105 panic("Unable to find SBA IOMMU: Try a generic or DIG kernel");
2106#endif
1da177e4 2107 return 0;
0b9afede
AW
2108 }
2109
2110#if defined(CONFIG_IA64_GENERIC) || defined(CONFIG_IA64_HP_ZX1_SWIOTLB)
2111 /*
2112 * hpzx1_swiotlb needs to have a fairly small swiotlb bounce
2113 * buffer setup to support devices with smaller DMA masks than
2114 * sba_iommu can handle.
2115 */
2116 if (ia64_platform_is("hpzx1_swiotlb")) {
2117 extern void hwsw_init(void);
2118
2119 hwsw_init();
2120 }
2121#endif
1da177e4
LT
2122
2123#ifdef CONFIG_PCI
2124 {
2125 struct pci_bus *b = NULL;
2126 while ((b = pci_find_next_bus(b)) != NULL)
2127 sba_connect_bus(b);
2128 }
2129#endif
2130
2131#ifdef CONFIG_PROC_FS
2132 ioc_proc_init();
2133#endif
2134 return 0;
2135}
2136
2137subsys_initcall(sba_init); /* must be initialized after ACPI etc., but before any drivers... */
2138
1da177e4
LT
2139static int __init
2140nosbagart(char *str)
2141{
2142 reserve_sba_gart = 0;
2143 return 1;
2144}
2145
2146int
2147sba_dma_supported (struct device *dev, u64 mask)
2148{
2149 /* make sure it's at least 32bit capable */
2150 return ((mask & 0xFFFFFFFFUL) == 0xFFFFFFFFUL);
2151}
2152
2153int
8d8bb39b 2154sba_dma_mapping_error(struct device *dev, dma_addr_t dma_addr)
1da177e4
LT
2155{
2156 return 0;
2157}
2158
2159__setup("nosbagart", nosbagart);
2160
2161static int __init
2162sba_page_override(char *str)
2163{
2164 unsigned long page_size;
2165
2166 page_size = memparse(str, &str);
2167 switch (page_size) {
2168 case 4096:
2169 case 8192:
2170 case 16384:
2171 case 65536:
2172 iovp_shift = ffs(page_size) - 1;
2173 break;
2174 default:
2175 printk("%s: unknown/unsupported iommu page size %ld\n",
d4ed8084 2176 __func__, page_size);
1da177e4
LT
2177 }
2178
2179 return 1;
2180}
2181
2182__setup("sbapagesize=",sba_page_override);
2183
2184EXPORT_SYMBOL(sba_dma_mapping_error);
1da177e4
LT
2185EXPORT_SYMBOL(sba_dma_supported);
2186EXPORT_SYMBOL(sba_alloc_coherent);
2187EXPORT_SYMBOL(sba_free_coherent);
0e9cbb9b
FT
2188
2189struct dma_mapping_ops sba_dma_ops = {
2190 .alloc_coherent = sba_alloc_coherent,
2191 .free_coherent = sba_free_coherent,
2192 .map_single_attrs = sba_map_single_attrs,
2193 .unmap_single_attrs = sba_unmap_single_attrs,
2194 .map_sg_attrs = sba_map_sg_attrs,
2195 .unmap_sg_attrs = sba_unmap_sg_attrs,
2196 .sync_single_for_cpu = machvec_dma_sync_single,
2197 .sync_sg_for_cpu = machvec_dma_sync_sg,
2198 .sync_single_for_device = machvec_dma_sync_single,
2199 .sync_sg_for_device = machvec_dma_sync_sg,
2200 .dma_supported_op = sba_dma_supported,
2201 .mapping_error = sba_dma_mapping_error,
2202};
4d9b977c
FT
2203
2204void sba_dma_init(void)
2205{
2206 dma_ops = &sba_dma_ops;
2207}