Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
hsi_char.c
Go to the documentation of this file.
1 /*
2  * HSI character device driver, implements the character device
3  * interface.
4  *
5  * Copyright (C) 2010 Nokia Corporation. All rights reserved.
6  *
7  * Contact: Andras Domokos <[email protected]>
8  *
9  * This program is free software; you can redistribute it and/or
10  * modify it under the terms of the GNU General Public License
11  * version 2 as published by the Free Software Foundation.
12  *
13  * This program is distributed in the hope that it will be useful, but
14  * WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16  * General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
21  * 02110-1301 USA
22  */
23 
24 #include <linux/errno.h>
25 #include <linux/types.h>
26 #include <linux/atomic.h>
27 #include <linux/kernel.h>
28 #include <linux/init.h>
29 #include <linux/module.h>
30 #include <linux/mutex.h>
31 #include <linux/list.h>
32 #include <linux/slab.h>
33 #include <linux/kmemleak.h>
34 #include <linux/ioctl.h>
35 #include <linux/wait.h>
36 #include <linux/fs.h>
37 #include <linux/sched.h>
38 #include <linux/device.h>
39 #include <linux/cdev.h>
40 #include <linux/uaccess.h>
41 #include <linux/scatterlist.h>
42 #include <linux/stat.h>
43 #include <linux/hsi/hsi.h>
44 #include <linux/hsi/hsi_char.h>
45 
46 #define HSC_DEVS 16 /* Num of channels */
47 #define HSC_MSGS 4
48 
49 #define HSC_RXBREAK 0
50 
51 #define HSC_ID_BITS 6
52 #define HSC_PORT_ID_BITS 4
53 #define HSC_ID_MASK 3
54 #define HSC_PORT_ID_MASK 3
55 #define HSC_CH_MASK 0xf
56 
57 /*
58  * We support up to 4 controllers that can have up to 4
59  * ports, which should currently be more than enough.
60  */
61 #define HSC_BASEMINOR(id, port_id) \
62  ((((id) & HSC_ID_MASK) << HSC_ID_BITS) | \
63  (((port_id) & HSC_PORT_ID_MASK) << HSC_PORT_ID_BITS))
64 
65 enum {
70 };
71 
72 enum {
75 };
76 
77 struct hsc_client_data;
91 struct hsc_channel {
92  unsigned int ch;
93  unsigned long flags;
98  struct hsi_client *cl;
102 };
103 
114  struct cdev cdev;
115  struct mutex lock;
116  unsigned long flags;
117  unsigned int usecnt;
118  struct hsi_client *cl;
120 };
121 
122 /* Stores the major number dynamically allocated for hsi_char */
123 static unsigned int hsc_major;
124 /* Maximum buffer size that hsi_char will accept from userspace */
125 static unsigned int max_data_size = 0x1000;
126 module_param(max_data_size, uint, 0);
127 MODULE_PARM_DESC(max_data_size, "max read/write data size [4,8..65536] (^2)");
128 
129 static void hsc_add_tail(struct hsc_channel *channel, struct hsi_msg *msg,
130  struct list_head *queue)
131 {
132  unsigned long flags;
133 
134  spin_lock_irqsave(&channel->lock, flags);
135  list_add_tail(&msg->link, queue);
136  spin_unlock_irqrestore(&channel->lock, flags);
137 }
138 
139 static struct hsi_msg *hsc_get_first_msg(struct hsc_channel *channel,
140  struct list_head *queue)
141 {
142  struct hsi_msg *msg = NULL;
143  unsigned long flags;
144 
145  spin_lock_irqsave(&channel->lock, flags);
146 
147  if (list_empty(queue))
148  goto out;
149 
150  msg = list_first_entry(queue, struct hsi_msg, link);
151  list_del(&msg->link);
152 out:
153  spin_unlock_irqrestore(&channel->lock, flags);
154 
155  return msg;
156 }
157 
158 static inline void hsc_msg_free(struct hsi_msg *msg)
159 {
160  kfree(sg_virt(msg->sgt.sgl));
161  hsi_free_msg(msg);
162 }
163 
164 static void hsc_free_list(struct list_head *list)
165 {
166  struct hsi_msg *msg, *tmp;
167 
168  list_for_each_entry_safe(msg, tmp, list, link) {
169  list_del(&msg->link);
170  hsc_msg_free(msg);
171  }
172 }
173 
174 static void hsc_reset_list(struct hsc_channel *channel, struct list_head *l)
175 {
176  unsigned long flags;
177  LIST_HEAD(list);
178 
179  spin_lock_irqsave(&channel->lock, flags);
180  list_splice_init(l, &list);
181  spin_unlock_irqrestore(&channel->lock, flags);
182 
183  hsc_free_list(&list);
184 }
185 
186 static inline struct hsi_msg *hsc_msg_alloc(unsigned int alloc_size)
187 {
188  struct hsi_msg *msg;
189  void *buf;
190 
191  msg = hsi_alloc_msg(1, GFP_KERNEL);
192  if (!msg)
193  goto out;
194  buf = kmalloc(alloc_size, GFP_KERNEL);
195  if (!buf) {
196  hsi_free_msg(msg);
197  goto out;
198  }
199  sg_init_one(msg->sgt.sgl, buf, alloc_size);
200  /* Ignore false positive, due to sg pointer handling */
201  kmemleak_ignore(buf);
202 
203  return msg;
204 out:
205  return NULL;
206 }
207 
208 static inline int hsc_msgs_alloc(struct hsc_channel *channel)
209 {
210  struct hsi_msg *msg;
211  int i;
212 
213  for (i = 0; i < HSC_MSGS; i++) {
214  msg = hsc_msg_alloc(max_data_size);
215  if (!msg)
216  goto out;
217  msg->channel = channel->ch;
218  list_add_tail(&msg->link, &channel->free_msgs_list);
219  }
220 
221  return 0;
222 out:
223  hsc_free_list(&channel->free_msgs_list);
224 
225  return -ENOMEM;
226 }
227 
228 static inline unsigned int hsc_msg_len_get(struct hsi_msg *msg)
229 {
230  return msg->sgt.sgl->length;
231 }
232 
233 static inline void hsc_msg_len_set(struct hsi_msg *msg, unsigned int len)
234 {
235  msg->sgt.sgl->length = len;
236 }
237 
238 static void hsc_rx_completed(struct hsi_msg *msg)
239 {
240  struct hsc_client_data *cl_data = hsi_client_drvdata(msg->cl);
241  struct hsc_channel *channel = cl_data->channels + msg->channel;
242 
243  if (test_bit(HSC_CH_READ, &channel->flags)) {
244  hsc_add_tail(channel, msg, &channel->rx_msgs_queue);
245  wake_up(&channel->rx_wait);
246  } else {
247  hsc_add_tail(channel, msg, &channel->free_msgs_list);
248  }
249 }
250 
251 static void hsc_rx_msg_destructor(struct hsi_msg *msg)
252 {
253  msg->status = HSI_STATUS_ERROR;
254  hsc_msg_len_set(msg, 0);
255  hsc_rx_completed(msg);
256 }
257 
258 static void hsc_tx_completed(struct hsi_msg *msg)
259 {
260  struct hsc_client_data *cl_data = hsi_client_drvdata(msg->cl);
261  struct hsc_channel *channel = cl_data->channels + msg->channel;
262 
263  if (test_bit(HSC_CH_WRITE, &channel->flags)) {
264  hsc_add_tail(channel, msg, &channel->tx_msgs_queue);
265  wake_up(&channel->tx_wait);
266  } else {
267  hsc_add_tail(channel, msg, &channel->free_msgs_list);
268  }
269 }
270 
271 static void hsc_tx_msg_destructor(struct hsi_msg *msg)
272 {
273  msg->status = HSI_STATUS_ERROR;
274  hsc_msg_len_set(msg, 0);
275  hsc_tx_completed(msg);
276 }
277 
278 static void hsc_break_req_destructor(struct hsi_msg *msg)
279 {
280  struct hsc_client_data *cl_data = hsi_client_drvdata(msg->cl);
281 
282  hsi_free_msg(msg);
283  clear_bit(HSC_RXBREAK, &cl_data->flags);
284 }
285 
286 static void hsc_break_received(struct hsi_msg *msg)
287 {
288  struct hsc_client_data *cl_data = hsi_client_drvdata(msg->cl);
289  struct hsc_channel *channel = cl_data->channels;
290  int i, ret;
291 
292  /* Broadcast HWBREAK on all channels */
293  for (i = 0; i < HSC_DEVS; i++, channel++) {
294  struct hsi_msg *msg2;
295 
296  if (!test_bit(HSC_CH_READ, &channel->flags))
297  continue;
298  msg2 = hsc_get_first_msg(channel, &channel->free_msgs_list);
299  if (!msg2)
300  continue;
301  clear_bit(HSC_CH_READ, &channel->flags);
302  hsc_msg_len_set(msg2, 0);
304  hsc_add_tail(channel, msg2, &channel->rx_msgs_queue);
305  wake_up(&channel->rx_wait);
306  }
307  hsi_flush(msg->cl);
308  ret = hsi_async_read(msg->cl, msg);
309  if (ret < 0)
310  hsc_break_req_destructor(msg);
311 }
312 
313 static int hsc_break_request(struct hsi_client *cl)
314 {
315  struct hsc_client_data *cl_data = hsi_client_drvdata(cl);
316  struct hsi_msg *msg;
317  int ret;
318 
319  if (test_and_set_bit(HSC_RXBREAK, &cl_data->flags))
320  return -EBUSY;
321 
322  msg = hsi_alloc_msg(0, GFP_KERNEL);
323  if (!msg) {
324  clear_bit(HSC_RXBREAK, &cl_data->flags);
325  return -ENOMEM;
326  }
327  msg->break_frame = 1;
328  msg->complete = hsc_break_received;
329  msg->destructor = hsc_break_req_destructor;
330  ret = hsi_async_read(cl, msg);
331  if (ret < 0)
332  hsc_break_req_destructor(msg);
333 
334  return ret;
335 }
336 
337 static int hsc_break_send(struct hsi_client *cl)
338 {
339  struct hsi_msg *msg;
340  int ret;
341 
342  msg = hsi_alloc_msg(0, GFP_ATOMIC);
343  if (!msg)
344  return -ENOMEM;
345  msg->break_frame = 1;
346  msg->complete = hsi_free_msg;
347  msg->destructor = hsi_free_msg;
348  ret = hsi_async_write(cl, msg);
349  if (ret < 0)
350  hsi_free_msg(msg);
351 
352  return ret;
353 }
354 
355 static int hsc_rx_set(struct hsi_client *cl, struct hsc_rx_config *rxc)
356 {
357  struct hsi_config tmp;
358  int ret;
359 
360  if ((rxc->mode != HSI_MODE_STREAM) && (rxc->mode != HSI_MODE_FRAME))
361  return -EINVAL;
362  if ((rxc->channels == 0) || (rxc->channels > HSC_DEVS))
363  return -EINVAL;
364  if (rxc->channels & (rxc->channels - 1))
365  return -EINVAL;
366  if ((rxc->flow != HSI_FLOW_SYNC) && (rxc->flow != HSI_FLOW_PIPE))
367  return -EINVAL;
368  tmp = cl->rx_cfg;
369  cl->rx_cfg.mode = rxc->mode;
370  cl->rx_cfg.channels = rxc->channels;
371  cl->rx_cfg.flow = rxc->flow;
372  ret = hsi_setup(cl);
373  if (ret < 0) {
374  cl->rx_cfg = tmp;
375  return ret;
376  }
377  if (rxc->mode == HSI_MODE_FRAME)
378  hsc_break_request(cl);
379 
380  return ret;
381 }
382 
383 static inline void hsc_rx_get(struct hsi_client *cl, struct hsc_rx_config *rxc)
384 {
385  rxc->mode = cl->rx_cfg.mode;
386  rxc->channels = cl->rx_cfg.channels;
387  rxc->flow = cl->rx_cfg.flow;
388 }
389 
390 static int hsc_tx_set(struct hsi_client *cl, struct hsc_tx_config *txc)
391 {
392  struct hsi_config tmp;
393  int ret;
394 
395  if ((txc->mode != HSI_MODE_STREAM) && (txc->mode != HSI_MODE_FRAME))
396  return -EINVAL;
397  if ((txc->channels == 0) || (txc->channels > HSC_DEVS))
398  return -EINVAL;
399  if (txc->channels & (txc->channels - 1))
400  return -EINVAL;
401  if ((txc->arb_mode != HSI_ARB_RR) && (txc->arb_mode != HSI_ARB_PRIO))
402  return -EINVAL;
403  tmp = cl->tx_cfg;
404  cl->tx_cfg.mode = txc->mode;
405  cl->tx_cfg.channels = txc->channels;
406  cl->tx_cfg.speed = txc->speed;
407  cl->tx_cfg.arb_mode = txc->arb_mode;
408  ret = hsi_setup(cl);
409  if (ret < 0) {
410  cl->tx_cfg = tmp;
411  return ret;
412  }
413 
414  return ret;
415 }
416 
417 static inline void hsc_tx_get(struct hsi_client *cl, struct hsc_tx_config *txc)
418 {
419  txc->mode = cl->tx_cfg.mode;
420  txc->channels = cl->tx_cfg.channels;
421  txc->speed = cl->tx_cfg.speed;
422  txc->arb_mode = cl->tx_cfg.arb_mode;
423 }
424 
425 static ssize_t hsc_read(struct file *file, char __user *buf, size_t len,
426  loff_t *ppos __maybe_unused)
427 {
428  struct hsc_channel *channel = file->private_data;
429  struct hsi_msg *msg;
430  ssize_t ret;
431 
432  if (len == 0)
433  return 0;
434  if (!IS_ALIGNED(len, sizeof(u32)))
435  return -EINVAL;
436  if (len > max_data_size)
437  len = max_data_size;
438  if (channel->ch >= channel->cl->rx_cfg.channels)
439  return -ECHRNG;
440  if (test_and_set_bit(HSC_CH_READ, &channel->flags))
441  return -EBUSY;
442  msg = hsc_get_first_msg(channel, &channel->free_msgs_list);
443  if (!msg) {
444  ret = -ENOSPC;
445  goto out;
446  }
447  hsc_msg_len_set(msg, len);
448  msg->complete = hsc_rx_completed;
449  msg->destructor = hsc_rx_msg_destructor;
450  ret = hsi_async_read(channel->cl, msg);
451  if (ret < 0) {
452  hsc_add_tail(channel, msg, &channel->free_msgs_list);
453  goto out;
454  }
455 
456  ret = wait_event_interruptible(channel->rx_wait,
457  !list_empty(&channel->rx_msgs_queue));
458  if (ret < 0) {
459  clear_bit(HSC_CH_READ, &channel->flags);
460  hsi_flush(channel->cl);
461  return -EINTR;
462  }
463 
464  msg = hsc_get_first_msg(channel, &channel->rx_msgs_queue);
465  if (msg) {
466  if (msg->status != HSI_STATUS_ERROR) {
467  ret = copy_to_user((void __user *)buf,
468  sg_virt(msg->sgt.sgl), hsc_msg_len_get(msg));
469  if (ret)
470  ret = -EFAULT;
471  else
472  ret = hsc_msg_len_get(msg);
473  } else {
474  ret = -EIO;
475  }
476  hsc_add_tail(channel, msg, &channel->free_msgs_list);
477  }
478 out:
479  clear_bit(HSC_CH_READ, &channel->flags);
480 
481  return ret;
482 }
483 
484 static ssize_t hsc_write(struct file *file, const char __user *buf, size_t len,
485  loff_t *ppos __maybe_unused)
486 {
487  struct hsc_channel *channel = file->private_data;
488  struct hsi_msg *msg;
489  ssize_t ret;
490 
491  if ((len == 0) || !IS_ALIGNED(len, sizeof(u32)))
492  return -EINVAL;
493  if (len > max_data_size)
494  len = max_data_size;
495  if (channel->ch >= channel->cl->tx_cfg.channels)
496  return -ECHRNG;
497  if (test_and_set_bit(HSC_CH_WRITE, &channel->flags))
498  return -EBUSY;
499  msg = hsc_get_first_msg(channel, &channel->free_msgs_list);
500  if (!msg) {
501  clear_bit(HSC_CH_WRITE, &channel->flags);
502  return -ENOSPC;
503  }
504  if (copy_from_user(sg_virt(msg->sgt.sgl), (void __user *)buf, len)) {
505  ret = -EFAULT;
506  goto out;
507  }
508  hsc_msg_len_set(msg, len);
509  msg->complete = hsc_tx_completed;
510  msg->destructor = hsc_tx_msg_destructor;
511  ret = hsi_async_write(channel->cl, msg);
512  if (ret < 0)
513  goto out;
514 
515  ret = wait_event_interruptible(channel->tx_wait,
516  !list_empty(&channel->tx_msgs_queue));
517  if (ret < 0) {
518  clear_bit(HSC_CH_WRITE, &channel->flags);
519  hsi_flush(channel->cl);
520  return -EINTR;
521  }
522 
523  msg = hsc_get_first_msg(channel, &channel->tx_msgs_queue);
524  if (msg) {
525  if (msg->status == HSI_STATUS_ERROR)
526  ret = -EIO;
527  else
528  ret = hsc_msg_len_get(msg);
529 
530  hsc_add_tail(channel, msg, &channel->free_msgs_list);
531  }
532 out:
533  clear_bit(HSC_CH_WRITE, &channel->flags);
534 
535  return ret;
536 }
537 
538 static long hsc_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
539 {
540  struct hsc_channel *channel = file->private_data;
541  unsigned int state;
542  struct hsc_rx_config rxc;
543  struct hsc_tx_config txc;
544  long ret = 0;
545 
546  switch (cmd) {
547  case HSC_RESET:
548  hsi_flush(channel->cl);
549  break;
550  case HSC_SET_PM:
551  if (copy_from_user(&state, (void __user *)arg, sizeof(state)))
552  return -EFAULT;
553  if (state == HSC_PM_DISABLE) {
554  if (test_and_set_bit(HSC_CH_WLINE, &channel->flags))
555  return -EINVAL;
556  ret = hsi_start_tx(channel->cl);
557  } else if (state == HSC_PM_ENABLE) {
558  if (!test_and_clear_bit(HSC_CH_WLINE, &channel->flags))
559  return -EINVAL;
560  ret = hsi_stop_tx(channel->cl);
561  } else {
562  ret = -EINVAL;
563  }
564  break;
565  case HSC_SEND_BREAK:
566  return hsc_break_send(channel->cl);
567  case HSC_SET_RX:
568  if (copy_from_user(&rxc, (void __user *)arg, sizeof(rxc)))
569  return -EFAULT;
570  return hsc_rx_set(channel->cl, &rxc);
571  case HSC_GET_RX:
572  hsc_rx_get(channel->cl, &rxc);
573  if (copy_to_user((void __user *)arg, &rxc, sizeof(rxc)))
574  return -EFAULT;
575  break;
576  case HSC_SET_TX:
577  if (copy_from_user(&txc, (void __user *)arg, sizeof(txc)))
578  return -EFAULT;
579  return hsc_tx_set(channel->cl, &txc);
580  case HSC_GET_TX:
581  hsc_tx_get(channel->cl, &txc);
582  if (copy_to_user((void __user *)arg, &txc, sizeof(txc)))
583  return -EFAULT;
584  break;
585  default:
586  return -ENOIOCTLCMD;
587  }
588 
589  return ret;
590 }
591 
592 static inline void __hsc_port_release(struct hsc_client_data *cl_data)
593 {
594  BUG_ON(cl_data->usecnt == 0);
595 
596  if (--cl_data->usecnt == 0) {
597  hsi_flush(cl_data->cl);
598  hsi_release_port(cl_data->cl);
599  }
600 }
601 
602 static int hsc_open(struct inode *inode, struct file *file)
603 {
604  struct hsc_client_data *cl_data;
605  struct hsc_channel *channel;
606  int ret = 0;
607 
608  pr_debug("open, minor = %d\n", iminor(inode));
609 
610  cl_data = container_of(inode->i_cdev, struct hsc_client_data, cdev);
611  mutex_lock(&cl_data->lock);
612  channel = cl_data->channels + (iminor(inode) & HSC_CH_MASK);
613 
614  if (test_and_set_bit(HSC_CH_OPEN, &channel->flags)) {
615  ret = -EBUSY;
616  goto out;
617  }
618  /*
619  * Check if we have already claimed the port associated to the HSI
620  * client. If not then try to claim it, else increase its refcount
621  */
622  if (cl_data->usecnt == 0) {
623  ret = hsi_claim_port(cl_data->cl, 0);
624  if (ret < 0)
625  goto out;
626  hsi_setup(cl_data->cl);
627  }
628  cl_data->usecnt++;
629 
630  ret = hsc_msgs_alloc(channel);
631  if (ret < 0) {
632  __hsc_port_release(cl_data);
633  goto out;
634  }
635 
636  file->private_data = channel;
637  mutex_unlock(&cl_data->lock);
638 
639  return ret;
640 out:
641  mutex_unlock(&cl_data->lock);
642 
643  return ret;
644 }
645 
646 static int hsc_release(struct inode *inode __maybe_unused, struct file *file)
647 {
648  struct hsc_channel *channel = file->private_data;
649  struct hsc_client_data *cl_data = channel->cl_data;
650 
651  mutex_lock(&cl_data->lock);
652  file->private_data = NULL;
653  if (test_and_clear_bit(HSC_CH_WLINE, &channel->flags))
654  hsi_stop_tx(channel->cl);
655  __hsc_port_release(cl_data);
656  hsc_reset_list(channel, &channel->rx_msgs_queue);
657  hsc_reset_list(channel, &channel->tx_msgs_queue);
658  hsc_reset_list(channel, &channel->free_msgs_list);
659  clear_bit(HSC_CH_READ, &channel->flags);
660  clear_bit(HSC_CH_WRITE, &channel->flags);
661  clear_bit(HSC_CH_OPEN, &channel->flags);
662  wake_up(&channel->rx_wait);
663  wake_up(&channel->tx_wait);
664  mutex_unlock(&cl_data->lock);
665 
666  return 0;
667 }
668 
669 static const struct file_operations hsc_fops = {
670  .owner = THIS_MODULE,
671  .read = hsc_read,
672  .write = hsc_write,
673  .unlocked_ioctl = hsc_ioctl,
674  .open = hsc_open,
675  .release = hsc_release,
676 };
677 
678 static void __devinit hsc_channel_init(struct hsc_channel *channel)
679 {
680  init_waitqueue_head(&channel->rx_wait);
681  init_waitqueue_head(&channel->tx_wait);
682  spin_lock_init(&channel->lock);
683  INIT_LIST_HEAD(&channel->free_msgs_list);
684  INIT_LIST_HEAD(&channel->rx_msgs_queue);
685  INIT_LIST_HEAD(&channel->tx_msgs_queue);
686 }
687 
688 static int __devinit hsc_probe(struct device *dev)
689 {
690  const char devname[] = "hsi_char";
691  struct hsc_client_data *cl_data;
692  struct hsc_channel *channel;
693  struct hsi_client *cl = to_hsi_client(dev);
694  unsigned int hsc_baseminor;
695  dev_t hsc_dev;
696  int ret;
697  int i;
698 
699  cl_data = kzalloc(sizeof(*cl_data), GFP_KERNEL);
700  if (!cl_data) {
701  dev_err(dev, "Could not allocate hsc_client_data\n");
702  return -ENOMEM;
703  }
704  hsc_baseminor = HSC_BASEMINOR(hsi_id(cl), hsi_port_id(cl));
705  if (!hsc_major) {
706  ret = alloc_chrdev_region(&hsc_dev, hsc_baseminor,
707  HSC_DEVS, devname);
708  if (ret > 0)
709  hsc_major = MAJOR(hsc_dev);
710  } else {
711  hsc_dev = MKDEV(hsc_major, hsc_baseminor);
712  ret = register_chrdev_region(hsc_dev, HSC_DEVS, devname);
713  }
714  if (ret < 0) {
715  dev_err(dev, "Device %s allocation failed %d\n",
716  hsc_major ? "minor" : "major", ret);
717  goto out1;
718  }
719  mutex_init(&cl_data->lock);
720  hsi_client_set_drvdata(cl, cl_data);
721  cdev_init(&cl_data->cdev, &hsc_fops);
722  cl_data->cdev.owner = THIS_MODULE;
723  cl_data->cl = cl;
724  for (i = 0, channel = cl_data->channels; i < HSC_DEVS; i++, channel++) {
725  hsc_channel_init(channel);
726  channel->ch = i;
727  channel->cl = cl;
728  channel->cl_data = cl_data;
729  }
730 
731  /* 1 hsi client -> N char devices (one for each channel) */
732  ret = cdev_add(&cl_data->cdev, hsc_dev, HSC_DEVS);
733  if (ret) {
734  dev_err(dev, "Could not add char device %d\n", ret);
735  goto out2;
736  }
737 
738  return 0;
739 out2:
740  unregister_chrdev_region(hsc_dev, HSC_DEVS);
741 out1:
742  kfree(cl_data);
743 
744  return ret;
745 }
746 
747 static int __devexit hsc_remove(struct device *dev)
748 {
749  struct hsi_client *cl = to_hsi_client(dev);
750  struct hsc_client_data *cl_data = hsi_client_drvdata(cl);
751  dev_t hsc_dev = cl_data->cdev.dev;
752 
753  cdev_del(&cl_data->cdev);
754  unregister_chrdev_region(hsc_dev, HSC_DEVS);
755  hsi_client_set_drvdata(cl, NULL);
756  kfree(cl_data);
757 
758  return 0;
759 }
760 
761 static struct hsi_client_driver hsc_driver = {
762  .driver = {
763  .name = "hsi_char",
764  .owner = THIS_MODULE,
765  .probe = hsc_probe,
766  .remove = __devexit_p(hsc_remove),
767  },
768 };
769 
770 static int __init hsc_init(void)
771 {
772  int ret;
773 
774  if ((max_data_size < 4) || (max_data_size > 0x10000) ||
775  (max_data_size & (max_data_size - 1))) {
776  pr_err("Invalid max read/write data size");
777  return -EINVAL;
778  }
779 
780  ret = hsi_register_client_driver(&hsc_driver);
781  if (ret) {
782  pr_err("Error while registering HSI/SSI driver %d", ret);
783  return ret;
784  }
785 
786  pr_info("HSI/SSI char device loaded\n");
787 
788  return 0;
789 }
790 module_init(hsc_init);
791 
792 static void __exit hsc_exit(void)
793 {
794  hsi_unregister_client_driver(&hsc_driver);
795  pr_info("HSI char device removed\n");
796 }
797 module_exit(hsc_exit);
798 
799 MODULE_AUTHOR("Andras Domokos <[email protected]>");
800 MODULE_ALIAS("hsi:hsi_char");
801 MODULE_DESCRIPTION("HSI character device");
802 MODULE_LICENSE("GPL v2");