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