b246b826ec694fed29f486e7ef281bbf9852501f
[openwrt/staging/yousong.git] /
1 From 8a9e2054d3ecf11044136daa5644d803db486dd4 Mon Sep 17 00:00:00 2001
2 From: detule <ogjoneski@gmail.com>
3 Date: Tue, 2 Oct 2018 04:10:08 -0400
4 Subject: [PATCH 141/703] vchiq_2835_arm: Implement a DMA pool for small bulk
5 transfers (#2699)
6
7 During a bulk transfer we request a DMA allocation to hold the
8 scatter-gather list. Most of the time, this allocation is small
9 (<< PAGE_SIZE), however it can be requested at a high enough frequency
10 to cause fragmentation and/or stress the CMA allocator (think time
11 spent in compaction here, or during allocations elsewhere).
12
13 Implement a pool to serve up small DMA allocations, falling back
14 to a coherent allocation if the request is greater than
15 VCHIQ_DMA_POOL_SIZE.
16
17 Signed-off-by: Oliver Gjoneski <ogjoneski@gmail.com>
18 ---
19 .../interface/vchiq_arm/vchiq_2835_arm.c | 40 +++++++++++++++----
20 1 file changed, 33 insertions(+), 7 deletions(-)
21
22 --- a/drivers/staging/vc04_services/interface/vchiq_arm/vchiq_2835_arm.c
23 +++ b/drivers/staging/vc04_services/interface/vchiq_arm/vchiq_2835_arm.c
24 @@ -37,6 +37,7 @@
25 #include <linux/interrupt.h>
26 #include <linux/pagemap.h>
27 #include <linux/dma-mapping.h>
28 +#include <linux/dmapool.h>
29 #include <linux/io.h>
30 #include <linux/platform_device.h>
31 #include <linux/uaccess.h>
32 @@ -60,6 +61,8 @@
33 #define BELL0 0x00
34 #define BELL2 0x08
35
36 +#define VCHIQ_DMA_POOL_SIZE PAGE_SIZE
37 +
38 struct vchiq_2835_state {
39 int inited;
40 VCHIQ_ARM_STATE_T arm_state;
41 @@ -69,6 +72,7 @@ struct vchiq_pagelist_info {
42 PAGELIST_T *pagelist;
43 size_t pagelist_buffer_size;
44 dma_addr_t dma_addr;
45 + bool is_from_pool;
46 enum dma_data_direction dma_dir;
47 unsigned int num_pages;
48 unsigned int pages_need_release;
49 @@ -91,6 +95,7 @@ static void __iomem *g_regs;
50 * relevant Device Tree node.
51 */
52 static unsigned int g_cache_line_size;
53 +static struct dma_pool *g_dma_pool;
54 static unsigned int g_fragments_size;
55 static char *g_fragments_base;
56 static char *g_free_fragments;
57 @@ -206,6 +211,14 @@ int vchiq_platform_init(struct platform_
58 }
59
60 g_dev = dev;
61 + g_dma_pool = dmam_pool_create("vchiq_scatter_pool", dev,
62 + VCHIQ_DMA_POOL_SIZE, g_cache_line_size,
63 + 0);
64 + if (!g_dma_pool) {
65 + dev_err(dev, "failed to create dma pool");
66 + return -ENOMEM;
67 + }
68 +
69 vchiq_log_info(vchiq_arm_log_level,
70 "vchiq_init - done (slots %pK, phys %pad)",
71 vchiq_slot_zero, &slot_phys);
72 @@ -397,9 +410,14 @@ cleanup_pagelistinfo(struct vchiq_pageli
73 for (i = 0; i < pagelistinfo->num_pages; i++)
74 put_page(pagelistinfo->pages[i]);
75 }
76 -
77 - dma_free_coherent(g_dev, pagelistinfo->pagelist_buffer_size,
78 - pagelistinfo->pagelist, pagelistinfo->dma_addr);
79 + if (pagelistinfo->is_from_pool) {
80 + dma_pool_free(g_dma_pool, pagelistinfo->pagelist,
81 + pagelistinfo->dma_addr);
82 + } else {
83 + dma_free_coherent(g_dev, pagelistinfo->pagelist_buffer_size,
84 + pagelistinfo->pagelist,
85 + pagelistinfo->dma_addr);
86 + }
87 }
88
89 /* There is a potential problem with partial cache lines (pages?)
90 @@ -419,6 +437,7 @@ create_pagelist(char __user *buf, size_t
91 u32 *addrs;
92 unsigned int num_pages, offset, i, k;
93 int actual_pages;
94 + bool is_from_pool;
95 size_t pagelist_size;
96 struct scatterlist *scatterlist, *sg;
97 int dma_buffers;
98 @@ -445,10 +464,16 @@ create_pagelist(char __user *buf, size_t
99 /* Allocate enough storage to hold the page pointers and the page
100 * list
101 */
102 - pagelist = dma_zalloc_coherent(g_dev,
103 - pagelist_size,
104 - &dma_addr,
105 - GFP_KERNEL);
106 + if (pagelist_size > VCHIQ_DMA_POOL_SIZE) {
107 + pagelist = dma_zalloc_coherent(g_dev,
108 + pagelist_size,
109 + &dma_addr,
110 + GFP_KERNEL);
111 + is_from_pool = false;
112 + } else {
113 + pagelist = dma_pool_zalloc(g_dma_pool, GFP_KERNEL, &dma_addr);
114 + is_from_pool = true;
115 + }
116
117 vchiq_log_trace(vchiq_arm_log_level, "%s - %pK", __func__, pagelist);
118
119 @@ -469,6 +494,7 @@ create_pagelist(char __user *buf, size_t
120 pagelistinfo->pagelist = pagelist;
121 pagelistinfo->pagelist_buffer_size = pagelist_size;
122 pagelistinfo->dma_addr = dma_addr;
123 + pagelistinfo->is_from_pool = is_from_pool;
124 pagelistinfo->dma_dir = (type == PAGELIST_WRITE) ?
125 DMA_TO_DEVICE : DMA_FROM_DEVICE;
126 pagelistinfo->num_pages = num_pages;