summaryrefslogtreecommitdiff
path: root/drivers/autotst/autotstdrv.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/autotst/autotstdrv.c')
-rw-r--r--drivers/autotst/autotstdrv.c440
1 files changed, 440 insertions, 0 deletions
diff --git a/drivers/autotst/autotstdrv.c b/drivers/autotst/autotstdrv.c
new file mode 100644
index 00000000..be14b956
--- /dev/null
+++ b/drivers/autotst/autotstdrv.c
@@ -0,0 +1,440 @@
+// ****************************************** //
+// access IIC, GPIO, etc. from user space by anli.wei
+// 2012-11-25
+// 2013-01-22 add key info anli.wei
+// ****************************************** //
+
+#include <linux/cdev.h>
+#include <linux/device.h>
+#include <linux/errno.h>
+#include <linux/fcntl.h>
+#include <linux/fs.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/input.h>
+#include <linux/interrupt.h>
+#include <linux/kernel.h>
+#include <linux/major.h>
+#include <linux/module.h>
+#include <linux/types.h>
+#include <soc/sprd/pinmap.h>
+
+#include <asm/io.h>
+#include <asm/uaccess.h>
+#include <soc/sprd/board.h>
+#include <soc/sprd/gpio.h>
+//
+#include "autotstdrv.h"
+#include "dispc.h"
+//
+#define DBG_ENABLE_FUN
+#define DBG_ENABLE_INFO
+
+#ifdef DBG_ENABLE_FUN
+#define FUN_ENTER printk(KERN_INFO "autotst-> %s ++.\n", __FUNCTION__)
+#define FUN_LEAVE printk(KERN_INFO "autotst-> %s --.\n", __FUNCTION__)
+#else
+#define FUN_ENTER do {} while(0)
+#define FUN_LEAVE do {} while(0)
+#endif // DBG_ENABLE_FUN
+
+#ifdef DBG_ENABLE_INFO
+#define DBG_INFO(fmt, arg...) printk(KERN_INFO "autotst-> " fmt, ##arg)
+#else
+#define DBG_INFO(fmt, arg...) do {} while(0)
+#endif // DBG_ENABLE_INFO
+
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+#define SPRD_MAX_PIN 200
+#define SPRD_GPIO_PIN_INVALID_VALUE 0xFFFFFFFF
+
+//static uint32_t sGpioPins[SPRD_MAX_PIN];
+
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+extern int lcm_init( void );
+extern int32_t lcm_send_data (uint32_t data);
+
+//------------------------------------------------------------------------------
+#define CDEV_NAME "autotst"
+
+static dev_t s_devt;
+static struct cdev s_cdev;
+static struct class *s_class;
+
+//------------------------------------------------------------------------------
+
+static int autotst_open (struct inode *inode, struct file *filp)
+{
+ FUN_ENTER;
+ FUN_LEAVE;
+ return 0;
+}
+
+static int autotst_release (struct inode *inode, struct file *filp)
+{
+ FUN_ENTER;
+ FUN_LEAVE;
+ return 0;
+}
+
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+
+static int i2c_read( struct autotst_i2c_info_t * info )
+{
+ struct i2c_msg xfer[2];
+ u8 reg[2], reg_len = 0;
+ u8 addr = (info->addr >> 1);
+ int ret;
+
+ struct i2c_adapter * adpt = i2c_get_adapter(info->bus);
+ if( NULL == adpt ) {
+ printk(KERN_ERR "get adapter(%d) fail!\n", info->bus);
+ return -ENXIO;
+ }
+
+ DBG_INFO("i2c read: bus = %d, addr = %X, reg = %X\n", info->bus, addr, info->reg);
+
+ if( 16 == info->regBits ) {
+ reg[reg_len++] = (u8)(info->reg >> 8);
+ }
+ reg[reg_len++] = (u8)(info->reg);
+
+ // Write address
+ xfer[0].addr = addr;
+ xfer[0].flags = 0;
+ xfer[0].len = reg_len;
+ xfer[0].buf = reg;
+
+ /* Read data */
+ xfer[1].addr = addr;
+ xfer[1].flags = I2C_M_RD;
+ xfer[1].len = info->data_len;
+ xfer[1].buf = info->data;
+
+ ret = i2c_transfer(adpt, xfer, 2);
+ if( ret < 0 ) {
+ printk(KERN_ERR "i2c_transfer() returned %d\n", ret);
+
+ i2c_put_adapter(adpt);
+ return ret;
+ }
+
+ DBG_INFO("i2c read done: bus = %d, addr = 0x%04X, reg = 0x%04X\n",
+ info->bus, info->addr, info->reg);
+
+ i2c_put_adapter(adpt);
+ return 0;
+}
+
+//------------------------------------------------------------------------------
+static int i2c_write( struct autotst_i2c_info_t * info )
+{
+ u8 buf[64];
+ u8 num = 0;
+ int ret, i;
+
+ struct i2c_msg xfer;
+
+ struct i2c_adapter * adpt = i2c_get_adapter(info->bus);
+ if( NULL == adpt ) {
+ printk(KERN_ERR "get adapter(%d) fail!\n", info->bus);
+ return -ENXIO;
+ }
+
+ if( 16 == info->regBits ) {
+ buf[num++] = (u8)(info->reg >> 8);
+ }
+
+ buf[num++] = (u8)(info->reg);
+
+ for( i = 0; i < info->data_len; ++i )
+ {
+ buf[num++] = info->data[i];
+ }
+
+ xfer.addr = info->addr;
+ xfer.flags = 0;
+ xfer.len = num;
+ xfer.buf = buf;
+
+ ret = i2c_transfer(adpt, &xfer, 1);
+ if( ret < 0 ) {
+ printk(KERN_ERR "i2c_transfer() returned %d\n", ret);
+
+ i2c_put_adapter(adpt);
+ return ret;
+ }
+
+ DBG_INFO("i2c write done: bus = %d, addr = 0x%04X, reg = 0x%04X\n",
+ info->bus, info->addr, info->reg);
+
+ i2c_put_adapter(adpt);
+ return 0;
+}
+
+//------------------------------------------------------------------------------
+static int i2c_ioctl( unsigned int cmd, unsigned long arg )
+{
+ int ret = 0;
+ struct autotst_i2c_info_t iit;
+
+ if( copy_from_user(&iit, (const void __user *)arg, sizeof(struct autotst_i2c_info_t)) ) {
+ printk(KERN_ERR "copy_from_user fail: arg = %lu\n", arg);
+ return -EFAULT;
+ }
+
+ switch( cmd ) {
+ case AUTOTST_IOCTL_I2C_READ:
+ ret = i2c_read( &iit );
+ if( ret == 0 ) {
+ if( copy_to_user((void __user *)arg, &iit, sizeof(struct autotst_i2c_info_t)) ) {
+ printk(KERN_ERR "copy_to_user fail: arg = %lu\n", arg);
+ ret = -EFAULT;
+ }
+ }
+ break;
+ case AUTOTST_IOCTL_I2C_WRITE:
+ ret = i2c_write( &iit );
+ break;
+ default:
+ ret = -EINVAL;
+ break;
+ }
+ return ret;
+}
+
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+
+static int gpio_ioctl( unsigned int cmd, unsigned long arg )
+{
+ int ret = 0;
+ int pull = 0;
+ struct autotst_gpio_info_t git;
+
+ if( copy_from_user(&git, (const void __user *)arg, sizeof(struct autotst_gpio_info_t)) ) {
+ printk(KERN_ERR "copy_from_user fail: arg = %lu\n", arg);
+ return -EFAULT;
+ }
+
+ switch( cmd ) {
+ case AUTOTST_IOCTL_GPIO_INIT:
+ {
+ char name[32];
+ snprintf(name, 32, "at_gio_%d", git.gpio);
+/* // not support, already config on platform
+ if( git.pup_enb ) {
+ }
+ if( git.pdwn_enb ) {
+ }
+*/
+ pull = ( (git.pdwn_enb << 6) & (BIT_PIN_WPD) ) | ((git.pup_enb << 7) & (BIT_PIN_WPU));
+ autotst_pin_ctrl(DISPC_PIN_FUNC3, git.gpio, pull);
+ gpio_request(git.gpio, name);
+ if( AUTOTST_GPIO_DIR_IN == git.dir ) {
+ gpio_direction_input(git.gpio);
+ } else {
+ gpio_direction_output(git.gpio, git.val);
+ }
+ }
+ break;
+ case AUTOTST_IOCTL_GPIO_GET: {
+ int gv = gpio_get_value(git.gpio);
+
+ git.val = (gv > 0) ? 1 : 0;
+ if( copy_to_user((void __user *)arg, &git, sizeof(struct autotst_gpio_info_t)) ) {
+ printk(KERN_ERR "copy_to_user fail: arg = %lu\n", arg);
+ ret = -EFAULT;
+ }
+ }
+ break;
+ case AUTOTST_IOCTL_GPIO_SET:
+ gpio_set_value(git.gpio, git.val);
+ break;
+ case AUTOTST_IOCTL_GPIO_CLOSE:
+ autotst_pin_ctrl(DISPC_PIN_FUNC0, git.gpio, pull);
+ break;
+ default:
+ ret = -EINVAL;
+ break;
+ }
+ return ret;
+}
+
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+
+static int key_ioctl( unsigned int cmd, unsigned long arg )
+{
+ int ret = 0;
+ struct autotst_key_info_t kit;
+
+ if( copy_from_user(&kit, (const void __user *)arg, sizeof(struct autotst_key_info_t)) ) {
+ printk(KERN_ERR "copy_from_user fail: arg = %lu\n", arg);
+ return -EFAULT;
+ }
+
+ if( KEY_POWER == kit.val ) {
+ kit.row = AUTOTST_KEY_INVALID_ROW;
+ kit.col = AUTOTST_KEY_INVALID_COL;
+ kit.gio = EIC_KEY_POWER;
+ } else {
+ unsigned char rc = (kit.val & 0xF7);
+
+ kit.row = ((rc >> 4) & 0x0F);
+ kit.col = ((rc >> 0) & 0x0F);
+ kit.gio = 0;
+ }
+
+ if( 0 == ret ) {
+ if( copy_to_user((void __user *)arg, &kit, sizeof(struct autotst_key_info_t)) ) {
+ printk(KERN_ERR "copy_to_user fail: arg = %lu\n", arg);
+ ret = -EFAULT;
+ }
+ }
+
+ return ret;
+}
+
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+
+static long autotst_ioctl( struct file *filp, unsigned int cmd, unsigned long arg )
+{
+ long ret = -1;
+
+ FUN_ENTER;
+
+ DBG_INFO("cmd = 0x%X\n", cmd);
+ switch( cmd ) {
+ case AUTOTST_IOCTL_I2C_READ:
+ case AUTOTST_IOCTL_I2C_WRITE:
+ ret = i2c_ioctl(cmd, arg);
+ break;
+ case AUTOTST_IOCTL_GPIO_INIT:
+ case AUTOTST_IOCTL_GPIO_GET:
+ case AUTOTST_IOCTL_GPIO_SET:
+ case AUTOTST_IOCTL_GPIO_CLOSE:
+ ret = gpio_ioctl(cmd, arg);
+ break;
+ case AUTOTST_IOCTL_LCD_DATA:
+ {
+ int i;
+ DBG_INFO("lcd data = 0x%X\n", (uint32_t)arg);
+#if 0
+ lcm_init();
+ for( i = 0; i < 32; ++i ) {
+ lcm_send_data((uint32_t)arg);
+ }
+#else
+ autotst_dispc_init(DISPLAY_TYPE_MCU);
+ for( i = 0; i < 32; ++i ) {
+ autotst_dispc_mcu_send_data((uint32_t)arg);
+ }
+ autotst_dispc_uninit(DISPLAY_TYPE_MCU);
+#endif
+ ret = 0;
+ }
+ break;
+#if 1
+ case AUTOTST_IOCTL_LCD_MIPI_ON:
+ {
+ int i;
+ DBG_INFO("lcd mipi on\n");
+ autotst_dispc_init(DISPLAY_TYPE_MIPI);
+ autotst_dispc_refresh();
+ ret = 0;
+ }
+ break;
+ case AUTOTST_IOCTL_LCD_MIPI_OFF:
+ {
+ int i;
+ DBG_INFO("lcd mipi off\n");
+ autotst_dispc_uninit(DISPLAY_TYPE_MIPI);
+ ret = 0;
+ }
+ break;
+#endif
+ case AUTOTST_IOCTL_GET_KEYINFO:
+ ret = key_ioctl(cmd, arg);
+ break;
+ default:
+ ret = -EINVAL;
+ DBG_INFO("lcd default \n");
+ break;
+ }
+
+ FUN_LEAVE;
+ return ret;
+}
+
+static struct file_operations autotst_fops =
+{
+ .owner = THIS_MODULE,
+ .unlocked_ioctl = autotst_ioctl,
+ .open = autotst_open,
+ .release = autotst_release,
+};
+
+//==============================================================================
+
+static int __init autotst_init(void)
+{
+ int ret;
+
+ FUN_ENTER;
+
+ // auto select a major
+ ret = alloc_chrdev_region(&s_devt, 0, 1, CDEV_NAME);
+ if( ret < 0 ) {
+ printk(KERN_ERR "ERROR: alloc_chrdev_region %d\n", ret);
+ return ret;
+ }
+
+ cdev_init(&s_cdev, &autotst_fops);
+ ret = cdev_add(&s_cdev, s_devt, 1);
+ if( ret < 0 )
+ {
+ unregister_chrdev_region(s_devt, 1);
+ printk(KERN_ERR "ERROR: cdev_add %d\n", ret);
+ return ret;
+ }
+
+ s_class = class_create(THIS_MODULE, CDEV_NAME);
+ device_create(s_class, NULL, MKDEV(MAJOR(s_devt), MINOR(s_devt)), NULL, CDEV_NAME);
+
+// autotst_dispc_pin_ctrl(DISPC_PIN_FUNC3);
+
+ //for( i = 0; i < SPRD_MAX_PIN; ++i ) {
+ // sGpioPins[i] = SPRD_GPIO_PIN_INVALID_VALUE;
+ //}
+ //sGpioPins[59] = MFP_CFG_X(SIMCLK3, AF3, DS1, F_PULL_NONE, S_PULL_NONE, IO_OE);
+
+ FUN_LEAVE;
+ return 0;
+}
+
+static void __exit autotst_exit(void)
+{
+ FUN_ENTER;
+
+ device_destroy(s_class, MKDEV(MAJOR(s_devt), MINOR(s_devt)));
+ class_destroy(s_class);
+
+ cdev_del(&s_cdev);
+ unregister_chrdev_region(s_devt, 1);
+
+// autotst_dispc_pin_ctrl(DISPC_PIN_FUNC0);
+
+ FUN_LEAVE;
+}
+
+module_init(autotst_init);
+module_exit(autotst_exit);
+
+MODULE_LICENSE("Dual BSD/GPL");
+MODULE_AUTHOR("anli.wei");
+MODULE_VERSION("0.0.1");
generated by cgit v1.3.1 (git 2.54.0) at 2026-08-15 22:35:06 +0000