123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429 |
- /* Copyright (c) 2012, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- */
- /* This driver implements a simple SPI read/write interface to access
- * an external device over SPI.
- */
- #include <linux/types.h>
- #include <linux/errno.h>
- #include <linux/spi/spi.h>
- #include <linux/module.h>
- #include <linux/types.h>
- #include <linux/device.h>
- #include <linux/cdev.h>
- #include <linux/fs.h>
- #include <linux/mutex.h>
- #include <linux/uaccess.h>
- #include <linux/gpio.h>
- #include <linux/delay.h>
- #include <linux/ci-bridge-spi.h>
- #define CI_MAX_BUFFER_SIZE (64 * 1024)
- struct ci_bridge {
- dev_t ci_bridge_dev;
- struct cdev cdev;
- struct class *bridge_class;
- struct device *bridge_dev;
- char *write_buffer;
- char *read_buffer;
- struct mutex lock;
- struct spi_device *spi;
- unsigned int gpio_reset_pin;
- unsigned int gpio_interrupt_pin;
- int num_opened;
- };
- static struct ci_bridge ci;
- static int __devinit ci_bridge_spi_probe(struct spi_device *spi)
- {
- int ret;
- struct ci_bridge_platform_data *pdata;
- if (spi->dev.platform_data == NULL) {
- pr_err("%s: platform data is missing\n", __func__);
- return -EINVAL;
- }
- ci.spi = spi;
- ci.num_opened = 0;
- mutex_init(&ci.lock);
- spi_set_drvdata(spi, &ci);
- pdata = spi->dev.platform_data;
- ci.gpio_reset_pin = pdata->reset_pin;
- ci.gpio_interrupt_pin = pdata->interrupt_pin;
- ret = gpio_request(ci.gpio_reset_pin, "ci_bridge_spi");
- if (ret) {
- pr_err("%s: GPIO request for pin number %u failed\n",
- __func__, ci.gpio_reset_pin);
- return ret;
- }
- ret = gpio_direction_output(ci.gpio_reset_pin, 1);
- if (ret) {
- pr_err("%s: unable to set GPIO direction, err=%d\n",
- __func__, ret);
- goto err_free_reset_pin;
- }
- ret = gpio_request(ci.gpio_interrupt_pin, "ci_bridge_spi");
- if (ret) {
- pr_err("%s: GPIO request for pin number %u failed\n",
- __func__, ci.gpio_interrupt_pin);
- goto err_free_reset_pin;
- }
- ret = gpio_direction_input(ci.gpio_interrupt_pin);
- if (ret) {
- pr_err("%s: unable to set GPIO direction, err=%d\n",
- __func__, ret);
- goto err_free_int_pin;
- }
- return 0;
- err_free_int_pin:
- gpio_free(ci.gpio_interrupt_pin);
- err_free_reset_pin:
- gpio_free(ci.gpio_reset_pin);
- return ret;
- }
- static int __devexit ci_bridge_spi_remove(struct spi_device *spi)
- {
- struct ci_bridge *bridge = spi_get_drvdata(spi);
- spi_set_drvdata(bridge->spi, NULL);
- bridge->spi = NULL;
- mutex_destroy(&ci.lock);
- gpio_free(ci.gpio_reset_pin);
- gpio_free(ci.gpio_interrupt_pin);
- return 0;
- }
- static struct spi_driver ci_bridge_driver = {
- .driver = {
- .name = "ci_bridge_spi",
- .owner = THIS_MODULE,
- },
- .probe = ci_bridge_spi_probe,
- .remove = __devexit_p(ci_bridge_spi_remove),
- };
- static void ci_bridge_spi_completion_cb(void *arg)
- {
- complete(arg);
- }
- static ssize_t ci_bridge_spi_read(struct file *filp,
- char __user *buf,
- size_t count,
- loff_t *f_pos)
- {
- int ret = 0;
- unsigned long not_copied = 0;
- struct spi_transfer spi_transfer;
- struct spi_message spi_message;
- DECLARE_COMPLETION_ONSTACK(context);
- struct ci_bridge *bridge = filp->private_data;
- if ((bridge == NULL) || (bridge->spi == NULL))
- return -ENODEV;
- if (count > CI_MAX_BUFFER_SIZE)
- return -EMSGSIZE;
- memset(&spi_transfer, 0, sizeof(struct spi_transfer));
- memset(&spi_message, 0, sizeof(struct spi_message));
- mutex_lock(&bridge->lock);
- spi_transfer.rx_buf = bridge->read_buffer;
- spi_transfer.len = count;
- spi_message_init(&spi_message);
- spi_message_add_tail(&spi_transfer, &spi_message);
- spi_message.complete = ci_bridge_spi_completion_cb;
- spi_message.context = &context;
- /* must use spi_async in a context that may sleep */
- ret = spi_async(bridge->spi, &spi_message);
- if (ret == 0) {
- wait_for_completion(&context);
- if (spi_message.status == 0) {
- /* spi_message.actual_length should contain the number
- * of bytes actually read and should update ret to be
- * the actual length, but since our driver doesn't
- * support this, assume all count bytes were read.
- */
- ret = count;
- }
- if (ret > 0) {
- not_copied =
- copy_to_user(buf, bridge->read_buffer, ret);
- if (not_copied == ret)
- ret = -EFAULT;
- else
- ret -= not_copied;
- }
- } else {
- pr_err("%s: Error calling spi_async, ret = %d\n",
- __func__, ret);
- }
- mutex_unlock(&bridge->lock);
- return ret;
- }
- static ssize_t ci_bridge_spi_write(struct file *filp,
- const char __user *buf,
- size_t count,
- loff_t *f_pos)
- {
- int ret = 0;
- unsigned long not_copied = 0;
- struct spi_transfer spi_transfer;
- struct spi_message spi_message;
- DECLARE_COMPLETION_ONSTACK(context);
- struct ci_bridge *bridge = filp->private_data;
- if ((bridge == NULL) || (bridge->spi == NULL))
- return -ENODEV;
- if (count > CI_MAX_BUFFER_SIZE)
- return -EMSGSIZE;
- memset(&spi_transfer, 0, sizeof(struct spi_transfer));
- memset(&spi_message, 0, sizeof(struct spi_message));
- mutex_lock(&bridge->lock);
- /* copy user data to our SPI Tx buffer */
- not_copied = copy_from_user(bridge->write_buffer, buf, count);
- if (not_copied != 0) {
- ret = -EFAULT;
- } else {
- spi_transfer.tx_buf = bridge->write_buffer;
- spi_transfer.len = count;
- spi_message_init(&spi_message);
- spi_message_add_tail(&spi_transfer, &spi_message);
- spi_message.complete = ci_bridge_spi_completion_cb;
- spi_message.context = &context;
- /* must use spi_async in a context that may sleep */
- ret = spi_async(bridge->spi, &spi_message);
- if (ret == 0) {
- wait_for_completion(&context);
- /* update ret to contain
- * the number of bytes actually written
- */
- if (spi_message.status == 0)
- ret = spi_transfer.len;
- else
- pr_err("%s: SPI transfer error, spi_message.status = %d\n",
- __func__, spi_message.status);
- } else {
- pr_err("%s: Error calling spi_async, ret = %d\n",
- __func__, ret);
- }
- }
- mutex_unlock(&bridge->lock);
- return ret;
- }
- static int ci_bridge_spi_open(struct inode *inode, struct file *filp)
- {
- /* forbid opening more then one instance at a time,
- parallel execution can still be problematic */
- if (ci.num_opened != 0)
- return -EBUSY;
- /* allocate write buffer */
- ci.write_buffer =
- kzalloc((CI_MAX_BUFFER_SIZE * sizeof(char)), GFP_KERNEL);
- if (ci.write_buffer == NULL) {
- pr_err("%s: Error allocating memory for write buffer\n",
- __func__);
- return -ENOMEM;
- }
- /* allocate read buffer */
- ci.read_buffer =
- kzalloc((CI_MAX_BUFFER_SIZE * sizeof(char)), GFP_KERNEL);
- if (ci.read_buffer == NULL) {
- pr_err("%s: Error allocating memory for read buffer\n",
- __func__);
- kfree(ci.write_buffer);
- return -ENOMEM;
- }
- /* device is non-seekable */
- nonseekable_open(inode, filp);
- filp->private_data = &ci;
- ci.num_opened = 1;
- return 0;
- }
- static int ci_bridge_ioctl_get_int(void *arg)
- {
- int state;
- if (arg == NULL)
- return -EINVAL;
- state = gpio_get_value_cansleep(ci.gpio_interrupt_pin);
- if (copy_to_user(arg, &state, sizeof(state)))
- return -EFAULT;
- return 0;
- }
- static int ci_bridge_ioctl_reset(unsigned long arg)
- {
- if ((arg != 0) && (arg != 1))
- return -EINVAL;
- gpio_set_value_cansleep(ci.gpio_reset_pin, arg);
- return 0;
- }
- static long ci_bridge_spi_ioctl(struct file *file, unsigned int cmd,
- unsigned long arg)
- {
- int ret;
- switch (cmd) {
- case CI_BRIDGE_IOCTL_RESET:
- ret = ci_bridge_ioctl_reset(arg);
- break;
- case CI_BRIDGE_IOCTL_GET_INT_STATE:
- ret = ci_bridge_ioctl_get_int((void *) arg);
- break;
- default:
- ret = -EINVAL;
- break;
- }
- return ret;
- }
- static int ci_bridge_spi_release(struct inode *inode, struct file *filp)
- {
- struct ci_bridge *bridge = filp->private_data;
- if ((bridge == NULL) || (bridge->spi == NULL))
- return -ENODEV;
- kfree(bridge->write_buffer);
- kfree(bridge->read_buffer);
- filp->private_data = NULL;
- ci.num_opened = 0;
- return 0;
- }
- static const struct file_operations ci_bridge_spi_fops = {
- .owner = THIS_MODULE,
- .read = ci_bridge_spi_read,
- .write = ci_bridge_spi_write,
- .open = ci_bridge_spi_open,
- .unlocked_ioctl = ci_bridge_spi_ioctl,
- .release = ci_bridge_spi_release,
- .llseek = no_llseek,
- };
- static int __init ci_bridge_init(void)
- {
- int ret = 0;
- ret = alloc_chrdev_region(&ci.ci_bridge_dev, 0, 1, "ci_bridge_spi");
- if (ret != 0)
- return ret;
- ci.bridge_class = class_create(THIS_MODULE, "ci_bridge_spi");
- if (IS_ERR(ci.bridge_class)) {
- ret = PTR_ERR(ci.bridge_class);
- pr_err("Error creating ci.bridge_class: %d\n", ret);
- goto free_region;
- }
- cdev_init(&ci.cdev, &ci_bridge_spi_fops);
- ci.cdev.owner = THIS_MODULE;
- ret = cdev_add(&ci.cdev, ci.ci_bridge_dev, 1);
- if (ret != 0) {
- pr_err("Error calling cdev_add: %d\n", ret);
- goto class_destroy;
- }
- ci.bridge_dev = device_create(ci.bridge_class, NULL, ci.cdev.dev,
- &ci, "ci_bridge_spi0");
- if (IS_ERR(ci.bridge_dev)) {
- ret = PTR_ERR(ci.bridge_dev);
- pr_err("device_create failed: %d\n", ret);
- goto del_cdev;
- }
- ret = spi_register_driver(&ci_bridge_driver);
- if (ret != 0) {
- pr_err("Error registering spi driver: %d\n", ret);
- goto device_destroy;
- }
- /* successful return */
- return 0;
- device_destroy:
- device_destroy(ci.bridge_class, ci.ci_bridge_dev);
- del_cdev:
- cdev_del(&ci.cdev);
- class_destroy:
- class_destroy(ci.bridge_class);
- free_region:
- unregister_chrdev_region(ci.ci_bridge_dev, 1);
- return ret;
- }
- static void __exit ci_bridge_exit(void)
- {
- spi_unregister_driver(&ci_bridge_driver);
- device_destroy(ci.bridge_class, ci.ci_bridge_dev);
- cdev_del(&ci.cdev);
- class_destroy(ci.bridge_class);
- unregister_chrdev_region(ci.ci_bridge_dev, 1);
- }
- module_init(ci_bridge_init);
- module_exit(ci_bridge_exit);
- MODULE_DESCRIPTION("CI Bridge SPI Driver");
- MODULE_LICENSE("GPL v2");
|