1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/module.h>
14#include <linux/poll.h>
15#include <linux/proc_fs.h>
16#include <linux/sched.h>
17#include <linux/smp_lock.h>
18
19#include "hysdn_defs.h"
20
21
22extern struct proc_dir_entry *hysdn_proc_entry;
23
24static void put_log_buffer(hysdn_card * card, char *cp);
25
26
27
28
29struct log_data {
30 struct log_data *next;
31 unsigned long usage_cnt;
32 void *proc_ctrl;
33 char log_start[2];
34};
35
36
37
38
39struct procdata {
40 struct proc_dir_entry *log;
41 char log_name[15];
42 struct log_data *log_head, *log_tail;
43 int if_used;
44 int volatile del_lock;
45 unsigned char logtmp[LOG_MAX_LINELEN];
46 wait_queue_head_t rd_queue;
47};
48
49
50
51
52
53void
54hysdn_card_errlog(hysdn_card * card, tErrLogEntry * logp, int maxsize)
55{
56 char buf[ERRLOG_TEXT_SIZE + 40];
57
58 sprintf(buf, "LOG 0x%08lX 0x%08lX : %s\n", logp->ulErrType, logp->ulErrSubtype, logp->ucText);
59 put_log_buffer(card, buf);
60}
61
62
63
64
65void
66hysdn_addlog(hysdn_card * card, char *fmt,...)
67{
68 struct procdata *pd = card->proclog;
69 char *cp;
70 va_list args;
71
72 if (!pd)
73 return;
74
75 cp = pd->logtmp;
76 cp += sprintf(cp, "HYSDN: card %d ", card->myid);
77
78 va_start(args, fmt);
79 cp += vsprintf(cp, fmt, args);
80 va_end(args);
81 *cp++ = '\n';
82 *cp = 0;
83
84 if (card->debug_flags & DEB_OUT_SYSLOG)
85 printk(KERN_INFO "%s", pd->logtmp);
86 else
87 put_log_buffer(card, pd->logtmp);
88
89}
90
91
92
93
94
95
96
97static void
98put_log_buffer(hysdn_card * card, char *cp)
99{
100 struct log_data *ib;
101 struct procdata *pd = card->proclog;
102 int i;
103 unsigned long flags;
104
105 if (!pd)
106 return;
107 if (!cp)
108 return;
109 if (!*cp)
110 return;
111 if (pd->if_used <= 0)
112 return;
113
114 if (!(ib = kmalloc(sizeof(struct log_data) + strlen(cp), GFP_ATOMIC)))
115 return;
116 strcpy(ib->log_start, cp);
117 ib->next = NULL;
118 ib->proc_ctrl = pd;
119 spin_lock_irqsave(&card->hysdn_lock, flags);
120 ib->usage_cnt = pd->if_used;
121 if (!pd->log_head)
122 pd->log_head = ib;
123 else
124 pd->log_tail->next = ib;
125 pd->log_tail = ib;
126 i = pd->del_lock++;
127 spin_unlock_irqrestore(&card->hysdn_lock, flags);
128
129
130 if (!i)
131 while (pd->log_head->next) {
132 if ((pd->log_head->usage_cnt <= 0) &&
133 (pd->log_head->next->usage_cnt <= 0)) {
134 ib = pd->log_head;
135 pd->log_head = pd->log_head->next;
136 kfree(ib);
137 } else
138 break;
139 }
140 pd->del_lock--;
141 wake_up_interruptible(&(pd->rd_queue));
142}
143
144
145
146
147
148
149
150
151
152static ssize_t
153hysdn_log_write(struct file *file, const char __user *buf, size_t count, loff_t * off)
154{
155 unsigned long u = 0;
156 int found = 0;
157 unsigned char *cp, valbuf[128];
158 long base = 10;
159 hysdn_card *card = (hysdn_card *) file->private_data;
160
161 if (count > (sizeof(valbuf) - 1))
162 count = sizeof(valbuf) - 1;
163 if (copy_from_user(valbuf, buf, count))
164 return (-EFAULT);
165
166 valbuf[count] = 0;
167 cp = valbuf;
168 if ((count > 2) && (valbuf[0] == '0') && (valbuf[1] == 'x')) {
169 cp += 2;
170 base = 16;
171 }
172
173 while (*cp) {
174 if ((*cp >= '0') && (*cp <= '9')) {
175 found = 1;
176 u *= base;
177 u += *cp++ - '0';
178 continue;
179 }
180 if (base != 16)
181 break;
182
183 if ((*cp >= 'a') && (*cp <= 'f')) {
184 found = 1;
185 u *= base;
186 u += *cp++ - 'a' + 10;
187 continue;
188 }
189 break;
190 }
191
192 if (found) {
193 card->debug_flags = u;
194 hysdn_addlog(card, "debug set to 0x%lx", card->debug_flags);
195 }
196 return (count);
197}
198
199
200
201
202static ssize_t
203hysdn_log_read(struct file *file, char __user *buf, size_t count, loff_t * off)
204{
205 struct log_data *inf;
206 int len;
207 struct proc_dir_entry *pde = PDE(file->f_path.dentry->d_inode);
208 struct procdata *pd = NULL;
209 hysdn_card *card;
210
211 if (!*((struct log_data **) file->private_data)) {
212 if (file->f_flags & O_NONBLOCK)
213 return (-EAGAIN);
214
215
216 card = card_root;
217 while (card) {
218 pd = card->proclog;
219 if (pd->log == pde)
220 break;
221 card = card->next;
222 }
223 if (card)
224 interruptible_sleep_on(&(pd->rd_queue));
225 else
226 return (-EAGAIN);
227
228 }
229 if (!(inf = *((struct log_data **) file->private_data)))
230 return (0);
231
232 inf->usage_cnt--;
233 file->private_data = &inf->next;
234 if ((len = strlen(inf->log_start)) <= count) {
235 if (copy_to_user(buf, inf->log_start, len))
236 return -EFAULT;
237 *off += len;
238 return (len);
239 }
240 return (0);
241}
242
243
244
245
246static int
247hysdn_log_open(struct inode *ino, struct file *filep)
248{
249 hysdn_card *card;
250 struct procdata *pd = NULL;
251 unsigned long flags;
252
253 lock_kernel();
254 card = card_root;
255 while (card) {
256 pd = card->proclog;
257 if (pd->log == PDE(ino))
258 break;
259 card = card->next;
260 }
261 if (!card) {
262 unlock_kernel();
263 return (-ENODEV);
264 }
265 filep->private_data = card;
266
267 if ((filep->f_mode & (FMODE_READ | FMODE_WRITE)) == FMODE_WRITE) {
268
269 } else if ((filep->f_mode & (FMODE_READ | FMODE_WRITE)) == FMODE_READ) {
270
271
272 spin_lock_irqsave(&card->hysdn_lock, flags);
273 pd->if_used++;
274 if (pd->log_head)
275 filep->private_data = &pd->log_tail->next;
276 else
277 filep->private_data = &pd->log_head;
278 spin_unlock_irqrestore(&card->hysdn_lock, flags);
279 } else {
280 unlock_kernel();
281 return (-EPERM);
282 }
283 unlock_kernel();
284 return nonseekable_open(ino, filep);
285}
286
287
288
289
290
291
292
293
294static int
295hysdn_log_close(struct inode *ino, struct file *filep)
296{
297 struct log_data *inf;
298 struct procdata *pd;
299 hysdn_card *card;
300 int retval = 0;
301
302 lock_kernel();
303 if ((filep->f_mode & (FMODE_READ | FMODE_WRITE)) == FMODE_WRITE) {
304
305 retval = 0;
306 } else {
307
308
309 pd = NULL;
310 inf = *((struct log_data **) filep->private_data);
311 if (inf)
312 pd = (struct procdata *) inf->proc_ctrl;
313 else {
314
315 card = card_root;
316 while (card) {
317 pd = card->proclog;
318 if (pd->log == PDE(ino))
319 break;
320 card = card->next;
321 }
322 if (card)
323 pd = card->proclog;
324 }
325 if (pd)
326 pd->if_used--;
327
328 while (inf) {
329 inf->usage_cnt--;
330 inf = inf->next;
331 }
332
333 if (pd)
334 if (pd->if_used <= 0)
335 while (pd->log_head) {
336 inf = pd->log_head;
337 pd->log_head = pd->log_head->next;
338 kfree(inf);
339 }
340 }
341 unlock_kernel();
342
343 return (retval);
344}
345
346
347
348
349static unsigned int
350hysdn_log_poll(struct file *file, poll_table * wait)
351{
352 unsigned int mask = 0;
353 struct proc_dir_entry *pde = PDE(file->f_path.dentry->d_inode);
354 hysdn_card *card;
355 struct procdata *pd = NULL;
356
357 if ((file->f_mode & (FMODE_READ | FMODE_WRITE)) == FMODE_WRITE)
358 return (mask);
359
360
361 card = card_root;
362 while (card) {
363 pd = card->proclog;
364 if (pd->log == pde)
365 break;
366 card = card->next;
367 }
368 if (!card)
369 return (mask);
370
371 poll_wait(file, &(pd->rd_queue), wait);
372
373 if (*((struct log_data **) file->private_data))
374 mask |= POLLIN | POLLRDNORM;
375
376 return mask;
377}
378
379
380
381
382static const struct file_operations log_fops =
383{
384 .owner = THIS_MODULE,
385 .llseek = no_llseek,
386 .read = hysdn_log_read,
387 .write = hysdn_log_write,
388 .poll = hysdn_log_poll,
389 .open = hysdn_log_open,
390 .release = hysdn_log_close,
391};
392
393
394
395
396
397
398int
399hysdn_proclog_init(hysdn_card * card)
400{
401 struct procdata *pd;
402
403
404
405 if ((pd = kzalloc(sizeof(struct procdata), GFP_KERNEL)) != NULL) {
406 sprintf(pd->log_name, "%s%d", PROC_LOG_BASENAME, card->myid);
407 pd->log = proc_create(pd->log_name,
408 S_IFREG | S_IRUGO | S_IWUSR, hysdn_proc_entry,
409 &log_fops);
410
411 init_waitqueue_head(&(pd->rd_queue));
412
413 card->proclog = (void *) pd;
414 }
415 return (0);
416}
417
418
419
420
421
422
423void
424hysdn_proclog_release(hysdn_card * card)
425{
426 struct procdata *pd;
427
428 if ((pd = (struct procdata *) card->proclog) != NULL) {
429 if (pd->log)
430 remove_proc_entry(pd->log_name, hysdn_proc_entry);
431 kfree(pd);
432 card->proclog = NULL;
433 }
434}
435