mirror of
https://github.com/hardkernel/linux.git
synced 2026-06-10 04:48:04 +09:00
add pca9554.c
This commit is contained in:
谢修鑫
970
drivers/gpio/pca9554.c
Normal file
970
drivers/gpio/pca9554.c
Normal file
@@ -0,0 +1,970 @@
|
||||
/* arch/arm/mach-rk2818/example.c
|
||||
*
|
||||
* Copyright (C) 2010 ROCKCHIP, Inc.
|
||||
*
|
||||
* This software is licensed under the terms of the GNU General Public
|
||||
* License version 2, as published by the Free Software Foundation, and
|
||||
* may be copied, distributed, and modified under those terms.
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
/*******************************************************************/
|
||||
/* COPYRIGHT (C) ROCK-CHIPS FUZHOU . ALL RIGHTS RESERVED. */
|
||||
/*******************************************************************
|
||||
FILE : PCA9554.C
|
||||
DESC : <20><>չGPIO <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>س<EFBFBD><D8B3><EFBFBD>
|
||||
AUTHOR : ZHONGYW
|
||||
DATE : 2009-4-26
|
||||
NOTES :
|
||||
$LOG: GPIO.C,V $
|
||||
REVISION 0.01
|
||||
********************************************************************/
|
||||
#include <linux/clk.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <asm/mach-types.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/debugfs.h>
|
||||
#include <linux/seq_file.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/io.h>
|
||||
#include <mach/hardware.h>
|
||||
#include <mach/gpio.h>
|
||||
#include <mach/rk2818_iomap.h>
|
||||
#include <mach/iomux.h>
|
||||
#include <linux/device.h>
|
||||
#include <mach/gpio.h>
|
||||
#include <asm/gpio.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include <mach/board.h>
|
||||
#define PCA9554_GPIO_IRQNum 8
|
||||
#define PCA9554_PortNum 1
|
||||
#define PCA9554_PortPinNum 8
|
||||
#define PCA9554_TotalPortPinNum (PCA9554_PortNum*PCA9554_PortPinNum)
|
||||
|
||||
#define PCA9554_InputLevel_Reg 0x0 //r only
|
||||
#define PCA9554_OutputLevel_Reg 0x1 // r/w default ffff
|
||||
#define PCA9554_Invert_Reg 0x2 // r/w default 0
|
||||
#define PCA9554_Config_Reg 0x3 // r/w default ffff
|
||||
|
||||
//#define PCA9554_INPUT_REG_IRQ_PIN RK2818_PIN_PE2
|
||||
|
||||
#define PCA9554_OUTREGLOCK
|
||||
#define PCA9554_INPUTREGLOCK
|
||||
#define PCA9554_CONFIGREGLOCK
|
||||
|
||||
struct pca9554_chip {
|
||||
/* the first extern gpio number in all of gpio groups */
|
||||
unsigned gpio_start;
|
||||
unsigned gpio_pin_num;
|
||||
/* the first gpio irq number in all of irq source */
|
||||
|
||||
unsigned gpio_irq_start;
|
||||
unsigned irq_pin_num; //<2F>жϵĸ<CFB5><C4B8><EFBFBD>
|
||||
unsigned irq_gpiopin; //<2F><><EFBFBD>жϵ<D0B6><CFB5>жϺ<D0B6>
|
||||
unsigned irq_chain; //<2F><><EFBFBD>жϵ<D0B6><CFB5>жϺ<D0B6>
|
||||
uint8_t reg_input[PCA9554_PortNum];
|
||||
uint8_t reg_output[PCA9554_PortNum];
|
||||
uint8_t reg_direction[PCA9554_PortNum];
|
||||
uint8_t interrupt_en[PCA9554_PortNum];// 0 dis
|
||||
uint8_t interrupt_mask[PCA9554_PortNum];// 0 unmask
|
||||
uint8_t inttype_set[PCA9554_PortNum]; // Inttype enable
|
||||
uint8_t inttype[PCA9554_PortNum]; //
|
||||
uint8_t inttype1[PCA9554_PortNum];
|
||||
|
||||
|
||||
#ifdef PCA9554_OUTREGLOCK
|
||||
struct mutex outreglock;
|
||||
#endif
|
||||
#ifdef PCA9554_INPUTREGLOCK
|
||||
struct mutex inputreglock;
|
||||
#endif
|
||||
#ifdef PCA9554_CONFIGREGLOCK
|
||||
struct mutex configreglock;
|
||||
#endif
|
||||
|
||||
struct i2c_client *client;
|
||||
struct pca9554_platform_data *dyn_pdata;
|
||||
struct work_struct pca9554_work;
|
||||
|
||||
struct gpio_chip gpio_chip;
|
||||
|
||||
char **names;
|
||||
};
|
||||
|
||||
|
||||
#if 1
|
||||
#define DBG(x...) printk(KERN_INFO x)
|
||||
#else
|
||||
#define DBG(x...)
|
||||
#endif
|
||||
|
||||
#if 1
|
||||
#define DBGERR(x...) printk(KERN_INFO x)
|
||||
#else
|
||||
#define DBGERR(x...)
|
||||
#endif
|
||||
|
||||
|
||||
struct i2c_client *pca9554_client;
|
||||
#define pca9554getbit(a,num) (((a)>>(num))&0x01)
|
||||
#define pca9554setbit(a,num) ((a)|(0x01<<(num)))
|
||||
#define pca9554clearbit(a,num) ((a)&(~(0x01<<(num))))
|
||||
|
||||
static short int portnum[PCA9554_PortNum]={PCA9554_PortPinNum};
|
||||
extern inline struct gpio_chip *gpio_to_chip(unsigned gpio);
|
||||
extern struct lock_class_key gpio_lock_class;
|
||||
extern struct lock_class_key gpio_lock_class;
|
||||
struct workqueue_struct *pca9554workqueue;
|
||||
|
||||
static const struct i2c_device_id pca9554_id[] =
|
||||
{
|
||||
{ "extend_gpio_pca9554", 8, },
|
||||
{ }
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(i2c, pca9554_id);
|
||||
|
||||
|
||||
static int pca9554_write_reg(struct i2c_client *client, uint8_t reg, uint8_t val)
|
||||
{
|
||||
int ret=-1;
|
||||
|
||||
struct i2c_adapter *adap;
|
||||
struct i2c_msg msg;
|
||||
char tx_buf[2];
|
||||
if(!client)
|
||||
return ret;
|
||||
adap = client->adapter;
|
||||
tx_buf[0] = reg;
|
||||
tx_buf[1]=val;
|
||||
|
||||
msg.addr = client->addr;
|
||||
msg.buf = &tx_buf[0];
|
||||
msg.len = 1 +1;
|
||||
msg.flags = client->flags;
|
||||
msg.scl_rate = 200*1000;
|
||||
|
||||
ret = i2c_transfer(adap, &msg, 1);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int pca9554_read_reg(struct i2c_client *client, uint8_t reg, uint8_t *val)
|
||||
{
|
||||
|
||||
int ret;
|
||||
struct i2c_adapter *adap;
|
||||
struct i2c_msg msgs[2];
|
||||
if(!client)
|
||||
return ret;
|
||||
adap = client->adapter;
|
||||
//<2F><><EFBFBD>ͼĴ<CDBC><C4B4><EFBFBD><EFBFBD><EFBFBD>ַ
|
||||
msgs[0].addr = client->addr;
|
||||
msgs[0].buf = ®
|
||||
msgs[0].flags = client->flags;
|
||||
msgs[0].len = 1;
|
||||
msgs[0].scl_rate = 200*1000;
|
||||
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
msgs[1].buf = val;
|
||||
msgs[1].addr = client->addr;
|
||||
msgs[1].flags = client->flags | I2C_M_RD;
|
||||
msgs[1].len = 1;
|
||||
msgs[1].scl_rate = 200*1000;
|
||||
|
||||
ret = i2c_transfer(adap, msgs, 2);
|
||||
//DBG("**has run at %s %d ret=%d**\n",__FUNCTION__,__LINE__,ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int pca9554_gpio_direction_input(struct gpio_chip *gc, unsigned off)
|
||||
{
|
||||
struct pca9554_chip *chip;
|
||||
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t reg_val;
|
||||
int ret=-1;
|
||||
DBG("**run in the %s**\n",__FUNCTION__);
|
||||
chip = container_of(gc, struct pca9554_chip, gpio_chip);
|
||||
|
||||
gpioPortNum = off/8;
|
||||
gpioPortPinNum= off%8;
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
return ret;
|
||||
|
||||
#ifdef PCA9554_CONFIGREGLOCK
|
||||
if (!mutex_trylock(&chip->configreglock))
|
||||
{
|
||||
DBGERR("**%s[%d]Did not get the configreglock**\n",__FUNCTION__,__LINE__);
|
||||
return ret;
|
||||
}
|
||||
#endif
|
||||
|
||||
reg_val = pca9554setbit(chip->reg_direction[gpioPortNum], gpioPortPinNum);
|
||||
ret = pca9554_write_reg(chip->client, PCA9554_Config_Reg, reg_val);
|
||||
if(ret<0)
|
||||
goto err;
|
||||
|
||||
chip->reg_direction[gpioPortNum] = reg_val;
|
||||
err:
|
||||
|
||||
DBG("**%s[%d],reg_val=%x,ret=%d**\n",__FUNCTION__,__LINE__,reg_val,ret);
|
||||
|
||||
#ifdef PCA9554_CONFIGREGLOCK
|
||||
mutex_unlock(&chip->configreglock);
|
||||
#endif
|
||||
|
||||
return (ret<0)?-1:0;
|
||||
}
|
||||
|
||||
static int pca9554_gpio_direction_output(struct gpio_chip *gc,unsigned off, int val)
|
||||
{
|
||||
struct pca9554_chip *chip;
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t reg_val;
|
||||
int ret=-1;
|
||||
DBG("**run in the %s**\n",__FUNCTION__);
|
||||
|
||||
chip = container_of(gc, struct pca9554_chip, gpio_chip);
|
||||
|
||||
gpioPortNum = off/8;
|
||||
gpioPortPinNum= off%8;
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
return ret;
|
||||
|
||||
#ifdef PCA9554_CONFIGREGLOCK
|
||||
if (!mutex_trylock(&chip->configreglock))
|
||||
{
|
||||
DBGERR("**%s[%d]Did not get the configreglock**\n",__FUNCTION__,__LINE__);
|
||||
return -1;
|
||||
}
|
||||
#endif
|
||||
/* then direction */
|
||||
reg_val = pca9554clearbit(chip->reg_direction[gpioPortNum], gpioPortPinNum);
|
||||
ret = pca9554_write_reg(chip->client, PCA9554_Config_Reg, reg_val);
|
||||
if(ret<0)
|
||||
{
|
||||
#ifdef PCA9554_CONFIGREGLOCK
|
||||
mutex_unlock(&chip->configreglock);
|
||||
#endif
|
||||
DBGERR("**%s[%d] set direction reg is error,reg_val=%x,ret=%d**\n",__FUNCTION__,__LINE__,reg_val,ret);
|
||||
return ret;
|
||||
}
|
||||
chip->reg_direction[gpioPortNum] = reg_val;
|
||||
#ifdef PCA9554_CONFIGREGLOCK
|
||||
mutex_unlock(&chip->configreglock);
|
||||
#endif
|
||||
ret=-1;
|
||||
#ifdef PCA9554_OUTREGLOCK
|
||||
if (!mutex_trylock(&chip->outreglock))
|
||||
{
|
||||
DBGERR("**%s[%d] Did not get the outreglock**\n",__FUNCTION__,__LINE__);
|
||||
return ret;
|
||||
}
|
||||
#endif
|
||||
/* set output level */
|
||||
if (val)
|
||||
reg_val = pca9554setbit(chip->reg_output[gpioPortNum], gpioPortPinNum);
|
||||
else
|
||||
reg_val = pca9554clearbit(chip->reg_output[gpioPortNum], gpioPortPinNum);
|
||||
|
||||
ret = pca9554_write_reg(chip->client, PCA9554_OutputLevel_Reg, reg_val);
|
||||
if (ret<0)
|
||||
{
|
||||
#ifdef PCA9554_OUTREGLOCK
|
||||
mutex_unlock(&chip->outreglock);
|
||||
#endif
|
||||
DBGERR("**%s[%d] set out reg is error,reg_val=%x,ret=%d**\n",__FUNCTION__,__LINE__,reg_val,ret);
|
||||
return ret;
|
||||
}
|
||||
chip->reg_output[gpioPortNum] = reg_val;
|
||||
|
||||
#ifdef PCA9554_OUTREGLOCK
|
||||
mutex_unlock(&chip->outreglock);
|
||||
#endif
|
||||
return (ret<0)?-1:0;
|
||||
}
|
||||
|
||||
static int pca9554_gpio_get_value(struct gpio_chip *gc, unsigned off)
|
||||
{
|
||||
struct pca9554_chip *chip;
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t reg_val;
|
||||
int ret=-1;
|
||||
DBG("**run in the %s**\n",__FUNCTION__);
|
||||
|
||||
chip = container_of(gc, struct pca9554_chip, gpio_chip);
|
||||
gpioPortNum = off/8;
|
||||
gpioPortPinNum= off%8;
|
||||
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
return -1;
|
||||
|
||||
if(!pca9554getbit(chip->reg_direction[gpioPortNum],gpioPortPinNum)) //<2F>жϸ<D0B6>pin<69>Ƿ<EFBFBD><C7B7><EFBFBD><EFBFBD>ó<EFBFBD>input
|
||||
return -1;
|
||||
#ifdef PCA9554_INPUTREGLOCK
|
||||
if (!mutex_trylock(&chip->inputreglock))
|
||||
{
|
||||
DBGERR("**%s[%d]Did not get the inputreglock**\n",__FUNCTION__,__LINE__);
|
||||
return -1;
|
||||
}
|
||||
#endif
|
||||
|
||||
ret = pca9554_read_reg(chip->client, PCA9554_InputLevel_Reg, ®_val);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
chip->reg_input[gpioPortNum] = reg_val;
|
||||
err:
|
||||
#ifdef PCA9554_CONFIGREGLOCK
|
||||
mutex_unlock(&chip->inputreglock);
|
||||
#endif
|
||||
DBGERR("**%s[%d]reg_val=%x,ret=%d**\n",__FUNCTION__,__LINE__,reg_val,ret);
|
||||
|
||||
return (ret < 0)?-1:((chip->reg_input[gpioPortNum] >> gpioPortPinNum) & 0x01);
|
||||
}
|
||||
|
||||
static void pca9554_gpio_set_value(struct gpio_chip *gc, unsigned off, int val)
|
||||
{
|
||||
struct pca9554_chip *chip;
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t reg_val;
|
||||
int ret=-1;
|
||||
DBG("**run in the %s**\n",__FUNCTION__);
|
||||
|
||||
chip = container_of(gc, struct pca9554_chip, gpio_chip);
|
||||
|
||||
gpioPortNum = off/8;
|
||||
gpioPortPinNum= off%8;
|
||||
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
return;// -1;
|
||||
|
||||
if(pca9554getbit(chip->reg_direction[gpioPortNum],gpioPortPinNum)) // input state
|
||||
return;// -1;
|
||||
|
||||
#ifdef PCA9554_OUTREGLOCK
|
||||
if (!mutex_trylock(&chip->outreglock))
|
||||
{
|
||||
DBGERR("**%s[%d] Did not get the outreglock**\n",__FUNCTION__,__LINE__);
|
||||
return;// -1;
|
||||
}
|
||||
#endif
|
||||
if (val)
|
||||
reg_val = pca9554setbit(chip->reg_output[gpioPortNum], gpioPortPinNum);
|
||||
else
|
||||
reg_val = pca9554clearbit(chip->reg_output[gpioPortNum], gpioPortPinNum);
|
||||
|
||||
ret = pca9554_write_reg(chip->client, PCA9554_OutputLevel_Reg, reg_val);
|
||||
if (ret<0)
|
||||
goto err;
|
||||
chip->reg_output[gpioPortNum] = reg_val;
|
||||
err:
|
||||
#ifdef PCA9554_OUTREGLOCK
|
||||
mutex_unlock(&chip->outreglock);
|
||||
#endif
|
||||
|
||||
DBG("**%s[%d],reg_val=%x,ret=%d**\n",__FUNCTION__,__LINE__,reg_val,ret);
|
||||
|
||||
return;// (ret<0)?-1:0;
|
||||
|
||||
}
|
||||
static int pca9554_gpio_to_irq(struct gpio_chip *chip,unsigned offset)
|
||||
{
|
||||
struct pca9554_chip *pca_chip = container_of(chip, struct pca9554_chip, gpio_chip);
|
||||
if(((pca_chip->gpio_start+offset)>=chip->base)&&((pca_chip->gpio_start+offset)<(chip->base+chip->ngpio)))
|
||||
{
|
||||
//DBG("**%s,offset=%d,gpio_irq_start=%d,base=%d,ngpio=%d,gpio_irq_start=%d**\n",
|
||||
// __FUNCTION__,offset,pca_chip->gpio_irq_start,chip->base,chip->ngpio,pca_chip->gpio_irq_start);
|
||||
return (offset+pca_chip->gpio_irq_start);
|
||||
}
|
||||
else
|
||||
return -1;
|
||||
}
|
||||
static void pca9554_setup_gpio(struct pca9554_chip *chip, int gpios)
|
||||
{
|
||||
struct gpio_chip *gc;
|
||||
|
||||
gc = &chip->gpio_chip;
|
||||
|
||||
gc->direction_input = pca9554_gpio_direction_input;
|
||||
gc->direction_output = pca9554_gpio_direction_output;
|
||||
gc->get = pca9554_gpio_get_value;
|
||||
gc->set = pca9554_gpio_set_value;
|
||||
gc->to_irq =pca9554_gpio_to_irq;
|
||||
|
||||
gc->can_sleep = 1;
|
||||
|
||||
gc->base = chip->gpio_start;
|
||||
gc->ngpio = chip->gpio_pin_num;
|
||||
gc->label = chip->client->name;
|
||||
gc->dev = &chip->client->dev;
|
||||
gc->owner = THIS_MODULE;
|
||||
gc->names = chip->names;
|
||||
}
|
||||
|
||||
int pca9554_checkrange(int start,int num,int val)
|
||||
{
|
||||
|
||||
if((val<(start+num))&&(val>=start))
|
||||
return 0;
|
||||
else return -1;
|
||||
|
||||
}
|
||||
static void pca9554_gpio_irq_enable(unsigned irq)
|
||||
{
|
||||
struct irq_desc *desc = irq_to_desc(irq);
|
||||
//int gpiopinnum;
|
||||
struct pca9554_chip *pchip=(struct pca9554_chip *)desc->chip_data;
|
||||
//struct gpio_chip *chip_gpio;
|
||||
unsigned gpio_num;
|
||||
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t pca9554pinnum;
|
||||
|
||||
|
||||
if(!pca9554_checkrange(pchip->gpio_irq_start,pchip->irq_pin_num,irq))
|
||||
{
|
||||
pca9554pinnum=irq-pchip->gpio_irq_start;
|
||||
}
|
||||
else return;
|
||||
gpioPortNum = pca9554pinnum/8;
|
||||
gpioPortPinNum= pca9554pinnum%8;
|
||||
gpio_num=pchip->gpio_start+pca9554pinnum;
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
return;
|
||||
DBG("**%s**\n",__FUNCTION__);
|
||||
pchip->interrupt_en[gpioPortNum]=pca9554setbit(pchip->interrupt_en[gpioPortNum],gpioPortPinNum);
|
||||
}
|
||||
static void pca9554_gpio_irq_disable(unsigned irq)
|
||||
{
|
||||
struct irq_desc *desc = irq_to_desc(irq);
|
||||
struct pca9554_chip *pchip=(struct pca9554_chip *)desc->chip_data;
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t pca9554pinnum;
|
||||
|
||||
|
||||
if(!pca9554_checkrange(pchip->gpio_irq_start,pchip->irq_pin_num,irq))
|
||||
{
|
||||
pca9554pinnum=irq-pchip->gpio_irq_start;//irq_to_gpio(irq)
|
||||
}
|
||||
else return;
|
||||
gpioPortNum = pca9554pinnum/8;
|
||||
gpioPortPinNum= pca9554pinnum%8;
|
||||
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
return;
|
||||
DBG("**%s**\n",__FUNCTION__);
|
||||
|
||||
pchip->interrupt_en[gpioPortNum]=pca9554clearbit(pchip->interrupt_en[gpioPortNum],gpioPortPinNum);
|
||||
|
||||
}
|
||||
|
||||
|
||||
static void pca9554_gpio_irq_mask(unsigned irq)
|
||||
{
|
||||
struct irq_desc *desc = irq_to_desc(irq);
|
||||
struct pca9554_chip *pchip=(struct pca9554_chip *)desc->chip_data;
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t pca9554pinnum;
|
||||
|
||||
|
||||
if(!pca9554_checkrange(pchip->gpio_irq_start,pchip->irq_pin_num,irq))
|
||||
{
|
||||
pca9554pinnum=irq-pchip->gpio_irq_start;//irq_to_gpio(irq)
|
||||
}
|
||||
else return;
|
||||
gpioPortNum = pca9554pinnum/8;
|
||||
gpioPortPinNum= pca9554pinnum%8;
|
||||
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
return;
|
||||
|
||||
DBG("**%s**\n",__FUNCTION__);
|
||||
|
||||
pchip->interrupt_mask[gpioPortNum]=pca9554setbit(pchip->interrupt_mask[gpioPortNum],gpioPortPinNum);
|
||||
|
||||
}
|
||||
|
||||
static void pca9554_gpio_irq_unmask(unsigned irq)
|
||||
{
|
||||
struct irq_desc *desc = irq_to_desc(irq);
|
||||
//int gpiopinnum;//=irq_to_gpio(irq);
|
||||
struct pca9554_chip *pchip=(struct pca9554_chip *)desc->chip_data;
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t pca9554pinnum;
|
||||
|
||||
DBG("**%s**\n",__FUNCTION__);
|
||||
|
||||
if(!pca9554_checkrange(pchip->gpio_irq_start,pchip->irq_pin_num,irq))
|
||||
{
|
||||
pca9554pinnum=irq-pchip->gpio_irq_start;//irq_to_gpio(irq)
|
||||
}
|
||||
else return;
|
||||
gpioPortNum = pca9554pinnum/8;
|
||||
gpioPortPinNum= pca9554pinnum%8;
|
||||
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
return;
|
||||
|
||||
|
||||
pchip->interrupt_mask[gpioPortNum]=pca9554clearbit(pchip->interrupt_mask[gpioPortNum],gpioPortPinNum);
|
||||
}
|
||||
|
||||
static int pca9554_gpio_irq_type(unsigned int irq, unsigned int type)
|
||||
{
|
||||
struct irq_desc *desc_irq=irq_to_desc(irq);
|
||||
struct pca9554_chip *pchip=(struct pca9554_chip *)desc_irq->chip_data;
|
||||
//struct gpio_chip *chip_gpio;
|
||||
int gpio_num;
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum;
|
||||
uint8_t pca9554pinnum;
|
||||
if(!pca9554_checkrange(pchip->gpio_irq_start,pchip->irq_pin_num,irq))
|
||||
{
|
||||
pca9554pinnum=irq-pchip->gpio_irq_start;//irq_to_gpio(irq)
|
||||
gpio_num=pchip->gpio_start+pca9554pinnum;
|
||||
}
|
||||
else
|
||||
return -1;
|
||||
|
||||
gpioPortNum = pca9554pinnum/8;
|
||||
gpioPortPinNum= pca9554pinnum%8;
|
||||
//DBG("**%s %d gpio_num=%d,PortNum=%d,PortPinNum=%d**\n",__FUNCTION__,__LINE__,gpio_num,gpioPortNum,gpioPortPinNum);
|
||||
switch (type) {
|
||||
case IRQ_TYPE_NONE:
|
||||
pchip->inttype_set[gpioPortNum]=pca9554clearbit(pchip->inttype_set[gpioPortNum],gpioPortPinNum);
|
||||
DBG("**%s IRQ_TYPE_NONE**\n",__FUNCTION__);
|
||||
break;
|
||||
case IRQ_TYPE_EDGE_RISING:
|
||||
pchip->inttype_set[gpioPortNum]=pca9554setbit(pchip->inttype_set[gpioPortNum],gpioPortPinNum);
|
||||
pchip->inttype[gpioPortNum]=pca9554setbit(pchip->inttype[gpioPortNum],gpioPortPinNum);
|
||||
pchip->inttype1[gpioPortNum]=pca9554clearbit(pchip->inttype1[gpioPortNum],gpioPortPinNum);
|
||||
DBG("**%s IRQ_TYPE_EDGE_RISING,inttype=%x,inttype1=%x**\n",__FUNCTION__,pchip->inttype[gpioPortNum],pchip->inttype1[gpioPortNum]);
|
||||
|
||||
break;
|
||||
case IRQ_TYPE_EDGE_FALLING:
|
||||
pchip->inttype_set[gpioPortNum]=pca9554setbit(pchip->inttype_set[gpioPortNum],gpioPortPinNum);
|
||||
pchip->inttype[gpioPortNum]=pca9554clearbit(pchip->inttype[gpioPortNum],gpioPortPinNum);
|
||||
pchip->inttype1[gpioPortNum]=pca9554clearbit(pchip->inttype1[gpioPortNum],gpioPortPinNum);
|
||||
DBG("**%s IRQ_TYPE_EDGE_RISING,inttype=%x,inttype1=%x**\n",__FUNCTION__,pchip->inttype[gpioPortNum],pchip->inttype1[gpioPortNum]);
|
||||
|
||||
break;
|
||||
case IRQ_TYPE_EDGE_BOTH:
|
||||
pchip->inttype_set[gpioPortNum]=pca9554setbit(pchip->inttype_set[gpioPortNum],gpioPortPinNum);
|
||||
pchip->inttype1[gpioPortNum]=pca9554setbit(pchip->inttype1[gpioPortNum],gpioPortPinNum);
|
||||
DBG("**%s IRQ_TYPE_EDGE_RISING,inttype=%x,inttype1=%x**\n",__FUNCTION__,pchip->inttype[gpioPortNum],pchip->inttype1[gpioPortNum]);
|
||||
break;
|
||||
case IRQ_TYPE_LEVEL_HIGH:
|
||||
pchip->inttype_set[gpioPortNum]=pca9554clearbit(pchip->inttype_set[gpioPortNum],gpioPortPinNum);
|
||||
DBG("extern gpios does not support IRQ_TYPE_LEVEL_HIGH irq typ");
|
||||
break;
|
||||
case IRQ_TYPE_LEVEL_LOW:
|
||||
pchip->inttype_set[gpioPortNum]=pca9554clearbit(pchip->inttype_set[gpioPortNum],gpioPortPinNum);
|
||||
DBG("extern gpios does not support IRQ_TYPE_LEVEL_LOW irq typ");
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int pca9554_gpio_irq_set_wake(unsigned irq, unsigned state)
|
||||
{
|
||||
//no irq wake
|
||||
return 0;
|
||||
|
||||
}
|
||||
static struct irq_chip pca9554_gpio_irqchip = {
|
||||
.name = "GPIO_EXT",
|
||||
.enable = pca9554_gpio_irq_enable,
|
||||
.disable = pca9554_gpio_irq_disable,
|
||||
.mask = pca9554_gpio_irq_mask,
|
||||
.unmask = pca9554_gpio_irq_unmask,
|
||||
.set_type = pca9554_gpio_irq_type,
|
||||
.set_wake = pca9554_gpio_irq_set_wake,
|
||||
};
|
||||
|
||||
static void pca9554_extend_gpio_irq_handler(struct work_struct *work)
|
||||
{
|
||||
struct pca9554_chip *pchip=container_of(work, struct pca9554_chip,pca9554_work);
|
||||
u8 tempintputreg[PCA9554_PortNum]={0};
|
||||
u8 tempallowint=0;
|
||||
u8 levelchg=0;
|
||||
u8 intbit=0;
|
||||
u8 tempinttype=0;
|
||||
int i,j;
|
||||
struct irq_desc *gpio_irq_desc;
|
||||
unsigned int irq;
|
||||
if(pca9554_read_reg(pchip->client,PCA9554_InputLevel_Reg,&tempintputreg[0])<0)
|
||||
{
|
||||
|
||||
DBG("**%s[%d] reading reg is error\n",__FUNCTION__,__LINE__);
|
||||
enable_irq(pchip->irq_chain);
|
||||
return;
|
||||
}
|
||||
|
||||
DBG("**has run at %s,intputreg=%x**\n",__FUNCTION__,tempintputreg[0]);
|
||||
if((pchip->interrupt_en[0]==0))
|
||||
{
|
||||
memcpy(&pchip->reg_input[0],&tempintputreg[0],sizeof(tempintputreg));
|
||||
DBGERR("there are no pin reg irq\n");
|
||||
enable_irq(pchip->irq_chain);
|
||||
return;
|
||||
}
|
||||
|
||||
for(i=0;i<PCA9554_PortNum;i++)
|
||||
{
|
||||
tempallowint=pchip->interrupt_en[i]&pchip->reg_direction[i]&(~pchip->interrupt_mask[i]);// <20><><EFBFBD><EFBFBD><EFBFBD>ж<EFBFBD><D0B6><EFBFBD><EFBFBD><EFBFBD>
|
||||
levelchg=pchip->reg_input[i]^tempintputreg[i];// <20>ҳ<EFBFBD>ǰ<EFBFBD><C7B0>״̬<D7B4><CCAC>һ<EFBFBD><D2BB><EFBFBD><EFBFBD>pin
|
||||
tempinttype=~(tempintputreg[i]^pchip->inttype[i]);// <20>ҳ<EFBFBD><D2B3><EFBFBD><EFBFBD><EFBFBD>״̬<D7B4>͵<EFBFBD>ǰpin״̬һ<CCAC><D2BB><EFBFBD><EFBFBD>pin<69><6E>ע<EFBFBD><D7A2>ֻ֧<D6BB><D6A7>low high<67><68><EFBFBD><EFBFBD>pin<69><6E><EFBFBD><EFBFBD>
|
||||
|
||||
tempinttype=(~pchip->inttype1[i])&tempinttype;// inttype1 Ϊ<><CEAA><EFBFBD><EFBFBD>λ<EFBFBD><CEBB>Ӧ<EFBFBD><D3A6>tempinttypeλ<65><CEBB><EFBFBD>㣬<EFBFBD><E3A3AC>Ϊ<EFBFBD><CEAA>λֻ<CEBB><D6BB>inttype1<65><31><EFBFBD><EFBFBD>
|
||||
tempinttype|=pchip->inttype1[i];//<2F><>ƽֻҪ<D6BB>DZ仯<C7B1>Ͳ<EFBFBD><CDB2><EFBFBD><EFBFBD>ж<EFBFBD>
|
||||
tempinttype&=pchip->inttype_set[i];//<2F>Ѿ<EFBFBD><D1BE><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>type<70><65><EFBFBD><EFBFBD>
|
||||
|
||||
intbit=tempallowint&levelchg&tempinttype;
|
||||
//DBG(" tempallowint=%x,levelchg=%x,tempinttype=%x,intbit=%d\n",tempallowint,levelchg,tempinttype,intbit);
|
||||
|
||||
if(intbit)
|
||||
for(j=0;j<portnum[i];j++)
|
||||
{
|
||||
if(pca9554getbit(intbit,j))
|
||||
{
|
||||
irq=pchip->gpio_irq_start+PCA9554_PortPinNum*i+j;
|
||||
gpio_irq_desc = irq_to_desc(irq);
|
||||
gpio_irq_desc->chip->mask(irq);
|
||||
generic_handle_irq(irq);
|
||||
gpio_irq_desc->chip->unmask(irq);
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
pchip->reg_input[i]=tempintputreg[i];
|
||||
|
||||
}
|
||||
enable_irq(pchip->irq_chain);
|
||||
return;
|
||||
}
|
||||
|
||||
static irqreturn_t pca9554_gpio_irq_handler(int irq, void * dev_id)
|
||||
{
|
||||
|
||||
struct irq_desc *gpio_irq_desc = irq_to_desc(irq);
|
||||
struct pca9554_chip *pchip=(struct pca9554_chip *)gpio_irq_desc->chip_data;
|
||||
|
||||
//DBG("**%s**\n",__FUNCTION__);
|
||||
disable_irq_nosync(pchip->irq_chain);
|
||||
queue_work(pca9554workqueue,&pchip->pca9554_work);
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
static void pca9554_gpio_irq_setup(struct pca9554_chip *pchip)
|
||||
{
|
||||
unsigned pioc, irq_num;
|
||||
int ret;
|
||||
struct irq_desc *desc;
|
||||
irq_num = pchip->gpio_irq_start; //<2F>жϺţ<CFBA><C5A3><EFBFBD>չio<69><6F><EFBFBD>жϺ<D0B6>Ӧ<EFBFBD>ý<EFBFBD><C3BD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڲ<EFBFBD>io<69>жϺŵĺ<C5B5><C4BA>档<EFBFBD><E6A1A3>rk<72>ڲ<EFBFBD><DAB2>ж<EFBFBD>48<34><38><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڲ<EFBFBD>gpio 16<31><36><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>жϣ<D0B6><CFA3><EFBFBD><EFBFBD><EFBFBD>pinӦ<6E>ô<EFBFBD>48+16<31><36>ʼ
|
||||
|
||||
for (pioc = 0; pioc < pchip->irq_pin_num; pioc++,irq_num++)
|
||||
{
|
||||
lockdep_set_class(&irq_desc[irq_num].lock, &gpio_lock_class);
|
||||
/*
|
||||
* Can use the "simple" and not "edge" handler since it's
|
||||
* shorter, and the AIC handles interrupts sanely.
|
||||
*/
|
||||
set_irq_chip(irq_num, &pca9554_gpio_irqchip);
|
||||
set_irq_handler(irq_num, handle_simple_irq);
|
||||
set_irq_chip_data(irq_num,(void *)pchip);
|
||||
desc = irq_to_desc(irq_num);
|
||||
//DBG("**%s line=%d,desc=%x,chipdate=%x,pchip=%x,irq_num=%d**\n",__FUNCTION__,__LINE__,desc,desc->chip_data,pchip,irq_num);
|
||||
|
||||
set_irq_flags(irq_num, IRQF_VALID);
|
||||
}
|
||||
ret=gpio_request(pchip->irq_gpiopin,NULL);
|
||||
if(ret!=0)
|
||||
{
|
||||
gpio_free(pchip->irq_gpiopin);
|
||||
DBG("pca9554_gpio_irq_setup request gpio is err\n");
|
||||
}
|
||||
|
||||
gpio_pull_updown(pchip->irq_gpiopin, GPIOPullUp); //gpio <20><>Ҫ<EFBFBD><D2AA><EFBFBD><EFBFBD>irq_to_gpio(pchip->irq_chain)
|
||||
|
||||
#if 0
|
||||
|
||||
set_irq_chip_data(pchip->irq_chain, pchip);
|
||||
set_irq_chained_handler(pchip->irq_chain, gpio_irq_handlerxxx);
|
||||
set_irq_type(pchip->irq_chain,IRQ_TYPE_LEVEL_LOW);
|
||||
enable_irq(pchip->irq_chain);
|
||||
|
||||
#else
|
||||
pca9554workqueue=create_workqueue("pca9554 workqueue");
|
||||
INIT_WORK(&pchip->pca9554_work,pca9554_extend_gpio_irq_handler);
|
||||
|
||||
set_irq_chip_data(pchip->irq_chain, pchip);
|
||||
if(request_irq(pchip->irq_chain,pca9554_gpio_irq_handler, IRQF_TRIGGER_LOW, "pca6424", pchip)!=0)
|
||||
{
|
||||
DBG("**%s line=%d is err**\n",__FUNCTION__,__LINE__);
|
||||
}
|
||||
|
||||
#endif
|
||||
}
|
||||
static irqreturn_t pca9554_gpio_irq_handler_test1(int irq, void * dev_id)
|
||||
{
|
||||
|
||||
DBG("***************************%s irq=%d***\n",__FUNCTION__,irq);
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
static irqreturn_t pca9554_gpio_irq_handler_test2(int irq, void * dev_id)
|
||||
{
|
||||
DBG("**************************%s irq=%d***\n",__FUNCTION__,irq);
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
void pca9554_test(struct pca9554_chip *chip)
|
||||
{
|
||||
struct i2c_client *client=chip->client;
|
||||
int ret;
|
||||
int irq1,irq2;
|
||||
|
||||
|
||||
|
||||
|
||||
ret=gpio_request(RK2818_PIN_PI4,NULL);
|
||||
if(ret!=0)
|
||||
DBG("*gpio_request in %d ret=%d*\n",__LINE__,ret);
|
||||
|
||||
ret=gpio_request(RK2818_PIN_PI5,NULL);
|
||||
if(ret!=0)
|
||||
DBG("*gpio_request in %d ret=%d*\n",__LINE__,ret);
|
||||
ret=gpio_request(RK2818_PIN_PI6,NULL);
|
||||
if(ret!=0)
|
||||
DBG("*gpio_request in %d ret=%d*\n",__LINE__,ret);
|
||||
ret=gpio_request(RK2818_PIN_PI7,NULL);
|
||||
if(ret!=0)
|
||||
DBG("*gpio_request in %d ret=%d*\n",__LINE__,ret);
|
||||
|
||||
irq1=gpio_to_irq(RK2818_PIN_PI4);
|
||||
request_irq(irq1, pca9554_gpio_irq_handler_test1, IRQF_TRIGGER_LOW,"xxx1", chip);
|
||||
|
||||
irq2=gpio_to_irq(RK2818_PIN_PI5);
|
||||
request_irq(irq2, pca9554_gpio_irq_handler_test2, IRQF_TRIGGER_HIGH, "xxx2", chip);
|
||||
|
||||
ret=gpio_direction_output(RK2818_PIN_PI6,GPIO_HIGH);
|
||||
ret=gpio_direction_output(RK2818_PIN_PI7,GPIO_LOW);
|
||||
|
||||
|
||||
}
|
||||
|
||||
int pca9554_init_pintype(struct pca9554_chip *chip,struct i2c_client *client)
|
||||
{
|
||||
int i;
|
||||
struct pca9554_platform_data *platform_data=(struct pca9554_platform_data *)client->dev.platform_data;
|
||||
struct rk2818_gpio_expander_info *pca9554_gpio_settinginfo;
|
||||
uint8_t reg_output[PCA9554_PortNum]={0};
|
||||
uint8_t reg_direction[PCA9554_PortNum]={0};
|
||||
uint8_t pca9554_pin_num;
|
||||
uint8_t gpioPortNum;
|
||||
uint8_t gpioPortPinNum,pca9554_settingpin_num=0;
|
||||
|
||||
if(platform_data)
|
||||
{
|
||||
pca9554_gpio_settinginfo=platform_data->settinginfo;
|
||||
if(pca9554_gpio_settinginfo)
|
||||
{
|
||||
pca9554_settingpin_num=platform_data->settinginfolen;
|
||||
for(i=0;i<pca9554_settingpin_num;i++)
|
||||
{
|
||||
if(!pca9554_checkrange(chip->gpio_start,chip->gpio_pin_num,pca9554_gpio_settinginfo[i].gpio_num))
|
||||
{
|
||||
pca9554_pin_num=pca9554_gpio_settinginfo[i].gpio_num-chip->gpio_start;
|
||||
gpioPortNum = pca9554_pin_num/PCA9554_PortPinNum;
|
||||
gpioPortPinNum= pca9554_pin_num%PCA9554_PortPinNum;
|
||||
//DBG("gpioPortNum=%d,gpioPortNum=%d,pca9554_pin_num=%d,reg_direction=%x,reg_output=%x,reg_input=%x\n",gpioPortNum,gpioPortPinNum,pca9554_pin_num,reg_direction[i],reg_output[i]);
|
||||
if((gpioPortNum>=PCA9554_PortNum)||(gpioPortPinNum>=portnum[gpioPortNum]))
|
||||
continue;
|
||||
if(pca9554_gpio_settinginfo[i].pin_type==GPIO_IN)
|
||||
reg_direction[gpioPortNum]=pca9554setbit(reg_direction[gpioPortNum],gpioPortPinNum);
|
||||
else
|
||||
{
|
||||
if(pca9554_gpio_settinginfo[i].pin_value==GPIO_HIGH)
|
||||
reg_output[gpioPortNum]=pca9554setbit(reg_output[gpioPortNum],gpioPortPinNum);
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
#ifdef PCA9554_OUTREGLOCK
|
||||
mutex_init(&chip->outreglock);
|
||||
#endif
|
||||
#ifdef PCA9554_INPUTREGLOCK
|
||||
mutex_init(&chip->inputreglock);
|
||||
#endif
|
||||
#ifdef PCA9554_OUTREGLOCK
|
||||
mutex_init(&chip->configreglock);
|
||||
#endif
|
||||
|
||||
for(i=0; i<PCA9554_PortNum; i++)
|
||||
{
|
||||
|
||||
if (pca9554_write_reg(client, PCA9554_Config_Reg, reg_direction[i])<0)
|
||||
{
|
||||
DBGERR("*%s %d* write reg err\n",__FUNCTION__,__LINE__);
|
||||
return -1;
|
||||
}
|
||||
chip->reg_direction[i]=reg_direction[i];
|
||||
if (pca9554_write_reg(client, PCA9554_OutputLevel_Reg, reg_output[i])<0)
|
||||
{
|
||||
DBGERR("*%s %d write reg err*\n",__FUNCTION__,__LINE__);
|
||||
return -1;
|
||||
}
|
||||
chip->reg_output[i]=reg_output[i];
|
||||
|
||||
if(pca9554_read_reg(client, PCA9554_InputLevel_Reg, &chip->reg_input[i])<0)
|
||||
{
|
||||
DBGERR("*%s %d read reg err*\n",__FUNCTION__,__LINE__);
|
||||
return -1;
|
||||
}
|
||||
//DBG("reg_direction=%x,reg_output=%x,reg_input=%x\n",chip->reg_direction[i],chip->reg_output[i],chip->reg_input[i]);
|
||||
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
static int __devinit pca9554_probe(struct i2c_client *client,const struct i2c_device_id *id)
|
||||
{
|
||||
struct pca9554_chip *chip;
|
||||
struct pca9554_platform_data *pdata;
|
||||
int ret;
|
||||
|
||||
DBG("**gpio %s in %d line,dev adr is %x**\n",__FUNCTION__,__LINE__,client->addr);
|
||||
if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
|
||||
return -EIO;
|
||||
|
||||
chip = kzalloc(sizeof(struct pca9554_chip), GFP_KERNEL);
|
||||
if (chip == NULL)
|
||||
return -ENOMEM;
|
||||
pdata = client->dev.platform_data;
|
||||
if (pdata == NULL) {
|
||||
DBGERR(" %s no platform data\n",__FUNCTION__);
|
||||
ret = -EINVAL;
|
||||
goto out_failed;
|
||||
}
|
||||
|
||||
chip->gpio_start = pdata->gpio_base;
|
||||
chip->gpio_irq_start =pdata->gpio_irq_start;
|
||||
chip->gpio_pin_num=pdata->gpio_pin_num;
|
||||
chip->irq_pin_num = pdata->irq_pin_num;
|
||||
chip->irq_gpiopin=pdata->pca9954_irq_pin;
|
||||
chip->irq_chain = gpio_to_irq(pdata->pca9954_irq_pin);
|
||||
chip->names =pdata->names;
|
||||
|
||||
//DBG("**%s in %d start=%d,irq_start=%d,pin_num=%d,irq_pin_num=%d,irq_gpiopin=%d,irq_chain=%d,**\n",
|
||||
// __FUNCTION__,__LINE__,chip->gpio_start,chip->gpio_irq_start,chip->gpio_pin_num,chip->irq_pin_num,chip->irq_gpiopin
|
||||
// ,chip->irq_chain);
|
||||
|
||||
/* initialize cached registers from their original values.
|
||||
* we can't share this chip with another i2c master.
|
||||
*/
|
||||
pca9554_setup_gpio(chip, id->driver_data);
|
||||
|
||||
ret = gpiochip_add(&chip->gpio_chip);
|
||||
if (ret)
|
||||
goto out_failed;
|
||||
|
||||
if(pca9554_init_pintype(chip,client))
|
||||
goto out_failed;
|
||||
|
||||
if (pdata->setup) {
|
||||
ret = pdata->setup(client, chip->gpio_chip.base,
|
||||
chip->gpio_chip.ngpio, pdata->context);
|
||||
if (ret < 0)
|
||||
DBGERR(" %s setup failed, %d\n",__FUNCTION__,ret);
|
||||
}
|
||||
|
||||
|
||||
pca9554_gpio_irq_setup(chip);
|
||||
|
||||
i2c_set_clientdata(client, chip);
|
||||
|
||||
|
||||
|
||||
chip->client = client;
|
||||
|
||||
pca9554_test(chip);
|
||||
|
||||
return 0;
|
||||
|
||||
out_failed:
|
||||
|
||||
kfree(chip);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int pca9554_remove(struct i2c_client *client)
|
||||
{
|
||||
struct pca9554_platform_data *pdata = client->dev.platform_data;
|
||||
struct pca9554_chip *chip = i2c_get_clientdata(client);
|
||||
int ret = 0;
|
||||
|
||||
if (pdata->teardown) {
|
||||
ret = pdata->teardown(client, chip->gpio_chip.base,
|
||||
chip->gpio_chip.ngpio, pdata->context);
|
||||
if (ret < 0) {
|
||||
DBGERR(" %s failed, %d\n",__FUNCTION__,ret);
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
ret = gpiochip_remove(&chip->gpio_chip);
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "%s failed, %d\n",
|
||||
"gpiochip_remove()", ret);
|
||||
return ret;
|
||||
}
|
||||
kfree(chip);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct i2c_driver pca9554_driver = {
|
||||
.driver = {
|
||||
.owner = THIS_MODULE,
|
||||
.name = "extend_gpio_pca9554",
|
||||
},
|
||||
.probe = pca9554_probe,
|
||||
.remove = pca9554_remove,
|
||||
.id_table = pca9554_id,
|
||||
};
|
||||
|
||||
static int __init pca9554_init(void)
|
||||
{
|
||||
DBG("**pca9554_init**\n");
|
||||
return i2c_add_driver(&pca9554_driver);
|
||||
}
|
||||
static void __exit pca9554_exit(void)
|
||||
{
|
||||
i2c_del_driver(&pca9554_driver);
|
||||
}
|
||||
|
||||
module_init(pca9554_init);
|
||||
module_exit(pca9554_exit);
|
||||
MODULE_AUTHOR(" XXX XXX@rock-chips.com");
|
||||
MODULE_DESCRIPTION("Driver for rk2818 extend gpio device");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
|
||||
Reference in New Issue
Block a user