1
2
3
4
5
6
7
8#include <linux/module.h>
9#include <linux/kernel.h>
10#include <linux/slab.h>
11#include <linux/device.h>
12#include <linux/mm.h>
13#include <linux/io.h>
14#include <linux/dma-mapping.h>
15#include <linux/dmapool.h>
16#include <linux/usb.h>
17#include <linux/usb/hcd.h>
18
19
20
21
22
23
24
25static size_t pool_max[HCD_BUFFER_POOLS] = {
26 32, 128, 512, 2048,
27};
28
29void __init usb_init_pool_max(void)
30{
31
32
33
34
35 if (ARCH_KMALLOC_MINALIGN <= 32)
36 ;
37 else if (ARCH_KMALLOC_MINALIGN <= 64)
38 pool_max[0] = 64;
39 else if (ARCH_KMALLOC_MINALIGN <= 128)
40 pool_max[0] = 0;
41 else
42 BUILD_BUG();
43}
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60int hcd_buffer_create(struct usb_hcd *hcd)
61{
62 char name[16];
63 int i, size;
64
65 if (!IS_ENABLED(CONFIG_HAS_DMA) ||
66 (!hcd->self.controller->dma_mask &&
67 !(hcd->driver->flags & HCD_LOCAL_MEM)))
68 return 0;
69
70 for (i = 0; i < HCD_BUFFER_POOLS; i++) {
71 size = pool_max[i];
72 if (!size)
73 continue;
74 snprintf(name, sizeof(name), "buffer-%d", size);
75 hcd->pool[i] = dma_pool_create(name, hcd->self.controller,
76 size, size, 0);
77 if (!hcd->pool[i]) {
78 hcd_buffer_destroy(hcd);
79 return -ENOMEM;
80 }
81 }
82 return 0;
83}
84
85
86
87
88
89
90
91
92
93void hcd_buffer_destroy(struct usb_hcd *hcd)
94{
95 int i;
96
97 if (!IS_ENABLED(CONFIG_HAS_DMA))
98 return;
99
100 for (i = 0; i < HCD_BUFFER_POOLS; i++) {
101 struct dma_pool *pool = hcd->pool[i];
102
103 if (pool) {
104 dma_pool_destroy(pool);
105 hcd->pool[i] = NULL;
106 }
107 }
108}
109
110
111
112
113
114
115void *hcd_buffer_alloc(
116 struct usb_bus *bus,
117 size_t size,
118 gfp_t mem_flags,
119 dma_addr_t *dma
120)
121{
122 struct usb_hcd *hcd = bus_to_hcd(bus);
123 int i;
124
125
126 if (!IS_ENABLED(CONFIG_HAS_DMA) ||
127 (!bus->controller->dma_mask &&
128 !(hcd->driver->flags & HCD_LOCAL_MEM))) {
129 *dma = ~(dma_addr_t) 0;
130 return kmalloc(size, mem_flags);
131 }
132
133 for (i = 0; i < HCD_BUFFER_POOLS; i++) {
134 if (size <= pool_max[i])
135 return dma_pool_alloc(hcd->pool[i], mem_flags, dma);
136 }
137 return dma_alloc_coherent(hcd->self.controller, size, dma, mem_flags);
138}
139
140void hcd_buffer_free(
141 struct usb_bus *bus,
142 size_t size,
143 void *addr,
144 dma_addr_t dma
145)
146{
147 struct usb_hcd *hcd = bus_to_hcd(bus);
148 int i;
149
150 if (!addr)
151 return;
152
153 if (!IS_ENABLED(CONFIG_HAS_DMA) ||
154 (!bus->controller->dma_mask &&
155 !(hcd->driver->flags & HCD_LOCAL_MEM))) {
156 kfree(addr);
157 return;
158 }
159
160 for (i = 0; i < HCD_BUFFER_POOLS; i++) {
161 if (size <= pool_max[i]) {
162 dma_pool_free(hcd->pool[i], addr, dma);
163 return;
164 }
165 }
166 dma_free_coherent(hcd->self.controller, size, addr, dma);
167}
168