1 /*
2 * Copyright (C) 2016 Red Hat
3 *
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
10 *
11 * The above copyright notice and this permission notice shall be included in
12 * all copies or substantial portions of the Software.
13 *
14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20 * OTHER DEALINGS IN THE SOFTWARE.
21 *
22 * Authors:
23 * Rob Clark <robdclark@gmail.com>
24 */
25
26 #define DEBUG /* for pr_debug() */
27
28 #include <stdarg.h>
29 #include <linux/seq_file.h>
30 #include <drm/drmP.h>
31 #include <drm/drm_print.h>
32
__drm_puts_coredump(struct drm_printer * p,const char * str)33 void __drm_puts_coredump(struct drm_printer *p, const char *str)
34 {
35 struct drm_print_iterator *iterator = p->arg;
36 ssize_t len;
37
38 if (!iterator->remain)
39 return;
40
41 if (iterator->offset < iterator->start) {
42 ssize_t copy;
43
44 len = strlen(str);
45
46 if (iterator->offset + len <= iterator->start) {
47 iterator->offset += len;
48 return;
49 }
50
51 copy = len - (iterator->start - iterator->offset);
52
53 if (copy > iterator->remain)
54 copy = iterator->remain;
55
56 /* Copy out the bit of the string that we need */
57 memcpy(iterator->data,
58 str + (iterator->start - iterator->offset), copy);
59
60 iterator->offset = iterator->start + copy;
61 iterator->remain -= copy;
62 } else {
63 ssize_t pos = iterator->offset - iterator->start;
64
65 len = min_t(ssize_t, strlen(str), iterator->remain);
66
67 memcpy(iterator->data + pos, str, len);
68
69 iterator->offset += len;
70 iterator->remain -= len;
71 }
72 }
73 EXPORT_SYMBOL(__drm_puts_coredump);
74
__drm_printfn_coredump(struct drm_printer * p,struct va_format * vaf)75 void __drm_printfn_coredump(struct drm_printer *p, struct va_format *vaf)
76 {
77 struct drm_print_iterator *iterator = p->arg;
78 size_t len;
79 char *buf;
80
81 if (!iterator->remain)
82 return;
83
84 /* Figure out how big the string will be */
85 len = snprintf(NULL, 0, "%pV", vaf);
86
87 /* This is the easiest path, we've already advanced beyond the offset */
88 if (iterator->offset + len <= iterator->start) {
89 iterator->offset += len;
90 return;
91 }
92
93 /* Then check if we can directly copy into the target buffer */
94 if ((iterator->offset >= iterator->start) && (len < iterator->remain)) {
95 ssize_t pos = iterator->offset - iterator->start;
96
97 snprintf(((char *) iterator->data) + pos,
98 iterator->remain, "%pV", vaf);
99
100 iterator->offset += len;
101 iterator->remain -= len;
102
103 return;
104 }
105
106 /*
107 * Finally, hit the slow path and make a temporary string to copy over
108 * using _drm_puts_coredump
109 */
110 buf = kmalloc(len + 1, GFP_KERNEL | __GFP_NOWARN | __GFP_NORETRY);
111 if (!buf)
112 return;
113
114 snprintf(buf, len + 1, "%pV", vaf);
115 __drm_puts_coredump(p, (const char *) buf);
116
117 kfree(buf);
118 }
119 EXPORT_SYMBOL(__drm_printfn_coredump);
120
__drm_puts_seq_file(struct drm_printer * p,const char * str)121 void __drm_puts_seq_file(struct drm_printer *p, const char *str)
122 {
123 seq_puts(p->arg, str);
124 }
125 EXPORT_SYMBOL(__drm_puts_seq_file);
126
__drm_printfn_seq_file(struct drm_printer * p,struct va_format * vaf)127 void __drm_printfn_seq_file(struct drm_printer *p, struct va_format *vaf)
128 {
129 seq_printf(p->arg, "%pV", vaf);
130 }
131 EXPORT_SYMBOL(__drm_printfn_seq_file);
132
__drm_printfn_info(struct drm_printer * p,struct va_format * vaf)133 void __drm_printfn_info(struct drm_printer *p, struct va_format *vaf)
134 {
135 dev_info(p->arg, "[" DRM_NAME "] %pV", vaf);
136 }
137 EXPORT_SYMBOL(__drm_printfn_info);
138
__drm_printfn_debug(struct drm_printer * p,struct va_format * vaf)139 void __drm_printfn_debug(struct drm_printer *p, struct va_format *vaf)
140 {
141 pr_debug("%s %pV", p->prefix, vaf);
142 }
143 EXPORT_SYMBOL(__drm_printfn_debug);
144
145 /**
146 * drm_puts - print a const string to a &drm_printer stream
147 * @p: the &drm printer
148 * @str: const string
149 *
150 * Allow &drm_printer types that have a constant string
151 * option to use it.
152 */
drm_puts(struct drm_printer * p,const char * str)153 void drm_puts(struct drm_printer *p, const char *str)
154 {
155 if (p->puts)
156 p->puts(p, str);
157 else
158 drm_printf(p, "%s", str);
159 }
160 EXPORT_SYMBOL(drm_puts);
161
162 /**
163 * drm_printf - print to a &drm_printer stream
164 * @p: the &drm_printer
165 * @f: format string
166 */
drm_printf(struct drm_printer * p,const char * f,...)167 void drm_printf(struct drm_printer *p, const char *f, ...)
168 {
169 va_list args;
170
171 va_start(args, f);
172 drm_vprintf(p, f, &args);
173 va_end(args);
174 }
175 EXPORT_SYMBOL(drm_printf);
176
drm_dev_printk(const struct device * dev,const char * level,const char * format,...)177 void drm_dev_printk(const struct device *dev, const char *level,
178 const char *format, ...)
179 {
180 struct va_format vaf;
181 va_list args;
182
183 va_start(args, format);
184 vaf.fmt = format;
185 vaf.va = &args;
186
187 if (dev)
188 dev_printk(level, dev, "[" DRM_NAME ":%ps] %pV",
189 __builtin_return_address(0), &vaf);
190 else
191 printk("%s" "[" DRM_NAME ":%ps] %pV",
192 level, __builtin_return_address(0), &vaf);
193
194 va_end(args);
195 }
196 EXPORT_SYMBOL(drm_dev_printk);
197
drm_dev_dbg(const struct device * dev,unsigned int category,const char * format,...)198 void drm_dev_dbg(const struct device *dev, unsigned int category,
199 const char *format, ...)
200 {
201 struct va_format vaf;
202 va_list args;
203
204 if (!(drm_debug & category))
205 return;
206
207 va_start(args, format);
208 vaf.fmt = format;
209 vaf.va = &args;
210
211 if (dev)
212 dev_printk(KERN_DEBUG, dev, "[" DRM_NAME ":%ps] %pV",
213 __builtin_return_address(0), &vaf);
214 else
215 printk(KERN_DEBUG "[" DRM_NAME ":%ps] %pV",
216 __builtin_return_address(0), &vaf);
217
218 va_end(args);
219 }
220 EXPORT_SYMBOL(drm_dev_dbg);
221
drm_dbg(unsigned int category,const char * format,...)222 void drm_dbg(unsigned int category, const char *format, ...)
223 {
224 struct va_format vaf;
225 va_list args;
226
227 if (!(drm_debug & category))
228 return;
229
230 va_start(args, format);
231 vaf.fmt = format;
232 vaf.va = &args;
233
234 printk(KERN_DEBUG "[" DRM_NAME ":%ps] %pV",
235 __builtin_return_address(0), &vaf);
236
237 va_end(args);
238 }
239 EXPORT_SYMBOL(drm_dbg);
240
drm_err(const char * format,...)241 void drm_err(const char *format, ...)
242 {
243 struct va_format vaf;
244 va_list args;
245
246 va_start(args, format);
247 vaf.fmt = format;
248 vaf.va = &args;
249
250 printk(KERN_ERR "[" DRM_NAME ":%ps] *ERROR* %pV",
251 __builtin_return_address(0), &vaf);
252
253 va_end(args);
254 }
255 EXPORT_SYMBOL(drm_err);
256