path: root/drivers/autotst/autotstdrv.c

// ****************************************** //
// 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");