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