Commit | Line | Data |
---|---|---|
4c1ec1f9 YK |
1 | /* |
2 | * CAAM/SEC 4.x functions for using scatterlists in caam driver | |
3 | * | |
4 | * Copyright 2008-2011 Freescale Semiconductor, Inc. | |
5 | * | |
6 | */ | |
7 | ||
a299c837 | 8 | struct sec4_sg_entry; |
4c1ec1f9 YK |
9 | |
10 | /* | |
11 | * convert single dma address to h/w link table format | |
12 | */ | |
a299c837 | 13 | static inline void dma_to_sec4_sg_one(struct sec4_sg_entry *sec4_sg_ptr, |
4c1ec1f9 YK |
14 | dma_addr_t dma, u32 len, u32 offset) |
15 | { | |
a299c837 YK |
16 | sec4_sg_ptr->ptr = dma; |
17 | sec4_sg_ptr->len = len; | |
a299c837 YK |
18 | sec4_sg_ptr->buf_pool_id = 0; |
19 | sec4_sg_ptr->offset = offset; | |
4c1ec1f9 | 20 | #ifdef DEBUG |
a299c837 YK |
21 | print_hex_dump(KERN_ERR, "sec4_sg_ptr@: ", |
22 | DUMP_PREFIX_ADDRESS, 16, 4, sec4_sg_ptr, | |
23 | sizeof(struct sec4_sg_entry), 1); | |
4c1ec1f9 YK |
24 | #endif |
25 | } | |
26 | ||
27 | /* | |
28 | * convert scatterlist to h/w link table format | |
29 | * but does not have final bit; instead, returns last entry | |
30 | */ | |
a299c837 YK |
31 | static inline struct sec4_sg_entry * |
32 | sg_to_sec4_sg(struct scatterlist *sg, int sg_count, | |
33 | struct sec4_sg_entry *sec4_sg_ptr, u32 offset) | |
4c1ec1f9 YK |
34 | { |
35 | while (sg_count) { | |
a299c837 | 36 | dma_to_sec4_sg_one(sec4_sg_ptr, sg_dma_address(sg), |
4c1ec1f9 | 37 | sg_dma_len(sg), offset); |
a299c837 | 38 | sec4_sg_ptr++; |
5be4d4c9 | 39 | sg = sg_next(sg); |
4c1ec1f9 YK |
40 | sg_count--; |
41 | } | |
a299c837 | 42 | return sec4_sg_ptr - 1; |
4c1ec1f9 YK |
43 | } |
44 | ||
45 | /* | |
46 | * convert scatterlist to h/w link table format | |
47 | * scatterlist must have been previously dma mapped | |
48 | */ | |
a299c837 YK |
49 | static inline void sg_to_sec4_sg_last(struct scatterlist *sg, int sg_count, |
50 | struct sec4_sg_entry *sec4_sg_ptr, | |
51 | u32 offset) | |
4c1ec1f9 | 52 | { |
a299c837 YK |
53 | sec4_sg_ptr = sg_to_sec4_sg(sg, sg_count, sec4_sg_ptr, offset); |
54 | sec4_sg_ptr->len |= SEC4_SG_LEN_FIN; | |
4c1ec1f9 YK |
55 | } |
56 | ||
70c3c8a9 HX |
57 | static inline struct sec4_sg_entry *sg_to_sec4_sg_len( |
58 | struct scatterlist *sg, unsigned int total, | |
59 | struct sec4_sg_entry *sec4_sg_ptr) | |
60 | { | |
61 | do { | |
62 | unsigned int len = min(sg_dma_len(sg), total); | |
63 | ||
64 | dma_to_sec4_sg_one(sec4_sg_ptr, sg_dma_address(sg), len, 0); | |
65 | sec4_sg_ptr++; | |
66 | sg = sg_next(sg); | |
67 | total -= len; | |
68 | } while (total); | |
69 | return sec4_sg_ptr - 1; | |
70 | } | |
71 | ||
4c1ec1f9 | 72 | /* count number of elements in scatterlist */ |
643b39b0 YK |
73 | static inline int __sg_count(struct scatterlist *sg_list, int nbytes, |
74 | bool *chained) | |
4c1ec1f9 YK |
75 | { |
76 | struct scatterlist *sg = sg_list; | |
77 | int sg_nents = 0; | |
78 | ||
79 | while (nbytes > 0) { | |
80 | sg_nents++; | |
81 | nbytes -= sg->length; | |
82 | if (!sg_is_last(sg) && (sg + 1)->length == 0) | |
643b39b0 | 83 | *chained = true; |
5be4d4c9 | 84 | sg = sg_next(sg); |
4c1ec1f9 YK |
85 | } |
86 | ||
87 | return sg_nents; | |
88 | } | |
89 | ||
90 | /* derive number of elements in scatterlist, but return 0 for 1 */ | |
643b39b0 YK |
91 | static inline int sg_count(struct scatterlist *sg_list, int nbytes, |
92 | bool *chained) | |
4c1ec1f9 | 93 | { |
643b39b0 | 94 | int sg_nents = __sg_count(sg_list, nbytes, chained); |
4c1ec1f9 YK |
95 | |
96 | if (likely(sg_nents == 1)) | |
97 | return 0; | |
98 | ||
99 | return sg_nents; | |
100 | } | |
045e3678 | 101 | |
6c94711c HX |
102 | static inline void dma_unmap_sg_chained( |
103 | struct device *dev, struct scatterlist *sg, unsigned int nents, | |
104 | enum dma_data_direction dir, bool chained) | |
643b39b0 YK |
105 | { |
106 | if (unlikely(chained)) { | |
107 | int i; | |
ec027303 VM |
108 | struct scatterlist *tsg = sg; |
109 | ||
110 | /* | |
111 | * Use a local copy of the sg pointer to avoid moving the | |
112 | * head of the list pointed to by sg as we walk the list. | |
113 | */ | |
643b39b0 | 114 | for (i = 0; i < nents; i++) { |
ec027303 VM |
115 | dma_unmap_sg(dev, tsg, 1, dir); |
116 | tsg = sg_next(tsg); | |
643b39b0 | 117 | } |
6c94711c HX |
118 | } else if (nents) { |
119 | dma_unmap_sg(dev, sg, nents, dir); | |
643b39b0 | 120 | } |
643b39b0 YK |
121 | } |
122 | ||
6c94711c HX |
123 | static inline int dma_map_sg_chained( |
124 | struct device *dev, struct scatterlist *sg, unsigned int nents, | |
125 | enum dma_data_direction dir, bool chained) | |
643b39b0 YK |
126 | { |
127 | if (unlikely(chained)) { | |
128 | int i; | |
ec027303 VM |
129 | struct scatterlist *tsg = sg; |
130 | ||
131 | /* | |
132 | * Use a local copy of the sg pointer to avoid moving the | |
133 | * head of the list pointed to by sg as we walk the list. | |
134 | */ | |
643b39b0 | 135 | for (i = 0; i < nents; i++) { |
ec027303 VM |
136 | if (!dma_map_sg(dev, tsg, 1, dir)) { |
137 | dma_unmap_sg_chained(dev, sg, i, dir, | |
6c94711c HX |
138 | chained); |
139 | nents = 0; | |
140 | break; | |
141 | } | |
142 | ||
ec027303 | 143 | tsg = sg_next(tsg); |
643b39b0 | 144 | } |
6c94711c HX |
145 | } else |
146 | nents = dma_map_sg(dev, sg, nents, dir); | |
147 | ||
643b39b0 YK |
148 | return nents; |
149 | } |