Linux驱动开发-编写MMA7660三轴加速度传感器

举报
DS小龙哥 发表于 2022/01/09 22:59:22 2022/01/09
【摘要】 通过MMA7660可以做出很多项目: 比如: 老人防跌倒手环、自行车自动刹车灯,智能闹钟,烤火炉跌倒自动断电、运动手环等等。 这篇文章就介绍如何在Linux下编写MMA7660三轴加速度芯片的驱动,读取当前芯片的方向姿态,得到X,Y,Z三个轴的数据。MMA7660是IIC接口的,当前驱动就采用标准的IIC子系统编写驱动,使用字符设备框架将得到的数据上传递给应用层。

1. MMA7660芯片介绍

MMA7660FC 是 ± 1.5 克的三轴数字输出、超低功率、紧凑型电容式微电机的三轴加速度计,是非常低功耗,小型容性 MEMS 的传感器。具有低通滤波器,用于偏移和增益误差补偿, 以及用户可配置的转换成 6 位分辨率,用户可配置输出速率等功能。MMA7660芯片可以通过中断引脚(INT)向外通知传感器数据变化、方向、姿态识别等信息。模拟工作电压范围是 2.4V 至 3.6V,数字工作电压范围是 1.71V 到 3.6V 。常用在手机、掌上电脑、车载导航,便携式电脑的防盗,自动自行车刹车灯、运动检测手环、数码机、自动叫醒闹钟里等等。

特别是计步的功能是现在最常见,不管是智能手环、还是手机都带有三轴加速度计,可以记录每天的步数,计算运动量等。现在很多的不倒翁,无人机、相机云台,很多常见的产品里都能看到三轴加速计的身影。

通过MMA7660可以做出很多项目: 比如: 老人防跌倒手环、自行车自动刹车灯,智能闹钟,烤火炉跌倒自动断电、运动手环等等。

这篇文章就介绍如何在Linux下编写MMA7660三轴加速度芯片的驱动,读取当前芯片的方向姿态,得到X,Y,Z三个轴的数据。MMA7660是IIC接口的,当前驱动就采用标准的IIC子系统编写驱动,使用字符设备框架将得到的数据上传递给应用层。

image-20220108211859294

image-20220108211941645

2. 硬件连线

当前使用的开发板是友善之臂Tiny4412开发板,使用三星EXYNOS4412芯片,板子本身自带了一颗MMA7660芯片,芯片的原理图如下:

image-20220108211848037

image-20220108211911111

内核本身有MMA7660的驱动,下面是源码的路径:

image-20220108212008898

image-20220108212025997

image-20220108212036925

如果加载自己编写的驱动,还需要去掉原来内核自带的驱动,不然无法匹配。

Device Drivers  --->
	<*> Hardware Monitoring support  --->  
        <*>   Freescale MMA7660 Accelerometer   (*号去掉,编译内核、烧写内核即可)

image-20220108212133903

3. 源代码

3.1 mma7660设备端代码: IIC子系统

#include <linux/init.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/i2c.h>
#include <linux/gpio.h>
#include <mach/gpio.h>
#include <plat/gpio-cfg.h>

static struct i2c_client *i2cClient = NULL;

static unsigned short  i2c_addr_list[]= {0x4c, I2C_CLIENT_END};/*地址队列*/

/*
1. 获取控制器(总线)
2. 探测设备是否存在
3. 定义一个名字用于找到驱动端
 */
static int __init mma7660_dev_init(void)
{
	/*mach-tiny4412.c*/
	struct i2c_adapter *i2c_adap=NULL;  /*获取到的总线存放在这个结构体*/
	struct i2c_board_info i2c_info;     /*设备描述结构体,里面存放着设备的名字还有地址*/

	/*1. 获取IIC控制器*/
	i2c_adap = i2c_get_adapter(3);     /*要使用IIC_3号总线*/
	if(!i2c_adap)
	{
		printk("获取IIC控制器信息失败!\n");
		return -1;
	}
	
	memset(&i2c_info,0,sizeof(struct i2c_board_info));      	/*清空结构体*/
	strlcpy(i2c_info.type,"mma7660_drv",I2C_NAME_SIZE);    /*名称的赋值*/
	i2c_info.irq=EXYNOS4_GPX3(1); /*中断IO口*/

	/*2. 创建IIC设备客户端*/
	i2cClient = i2c_new_probed_device(i2c_adap,&i2c_info,i2c_addr_list,NULL);
	if(!i2cClient)
	{
		printk("mma7660_探测地址出现错误!!\n");
		return -1;
	}

	i2c_put_adapter(i2c_adap);/*设置模块使用计数*/
	
	printk("mma7660_dev_init!!\n");
	return 0;
}


static void __exit mma7660_dev_exit(void)//平台设备端的出口函数
{
	printk(" mma7660_dev_exit ok!!\n");

	/*注销设备*/
	i2c_unregister_device(i2cClient);

	/*释放*/
	i2c_release_client(i2cClient);
}


module_init(mma7660_dev_init);
module_exit(mma7660_dev_exit);
MODULE_LICENSE("GPL");

3.2 mma7660驱动端代码: IIC子系统

#include <linux/init.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/i2c.h>
#include <linux/irq.h>
#include <linux/interrupt.h>
#include <linux/gpio.h>
#include <mach/gpio.h>
#include <plat/gpio-cfg.h>
#include <linux/workqueue.h>
#include <linux/delay.h>

/* MMA7760 Registers */
#define MMA7660_XOUT			0x00	// 6-bit output value X
#define MMA7660_YOUT			0x01	// 6-bit output value Y
#define MMA7660_ZOUT			0x02	// 6-bit output value Z
#define MMA7660_TILT			0x03	// Tilt status
#define MMA7660_SRST			0x04	// Sampling Rate Status
#define MMA7660_SPCNT			0x05	// Sleep Count
#define MMA7660_INTSU			0x06	// Interrupt Setup
#define MMA7660_MODE			0x07	// Mode
#define MMA7660_SR				0x08	// Auto-Wake/Sleep and Debounce Filter
#define MMA7660_PDET			0x09	// Tap Detection
#define MMA7660_PD				0x0a	// Tap Debounce Count

static const struct i2c_device_id mma7660_id[] =
{
	{"mma7660_drv",0}, /*设备端的名字,0表示不需要私有数据*/
	{}
};


static u32 mma7660_irq; /*触摸屏的中断编号*/
static struct i2c_client *mma7660_client=NULL;
static int	last_tilt = 0;

#define __need_retry(__v)	(__v & (1 << 6))
#define __is_negative(__v)	(__v & (1 << 5))

static const char *mma7660_bafro[] = {
	"未知", "前面", "背面"
};

static const char *mma7660_pola[] = {
	"未知",
	"左面", "向右",
	"保留", "保留",
	"向下", "向上",
	"保留",
};

/*
函数功能:读取一个字节的数据
*/
static int mma7660_read_tilt(struct i2c_client *client, int *tilt)
{
	int val;
	do {
		val = i2c_smbus_read_byte_data(client, MMA7660_TILT);
	} while (__need_retry(val));
	*tilt = (val & 0xff);
	return 0;
}


/*
函数功能: 读取XYZ坐标数据
*/
static int mma7660_read_xyz(struct i2c_client *client, int idx, int *xyz)
{
	int val;
	do {
		val = i2c_smbus_read_byte_data(client, idx + MMA7660_XOUT);
	} while (__need_retry(val));
	*xyz = __is_negative(val) ? (val | ~0x3f) : (val & 0x3f);
	return 0;
}


/*
工作队列处理函数
*/
static void mma7660_worker(struct work_struct *work)
{
	int bafro, pola, shake, tap;
	int val = 0;

	mma7660_read_tilt(mma7660_client,&val);

	/* TODO: report it ? */
	bafro = val & 0x03;
	if (bafro != (last_tilt & 0x03)) {
		printk("%s\n", mma7660_bafro[bafro]);
	}

	pola = (val >> 2) & 0x07;
	if (pola != ((last_tilt >> 2) & 0x07)) {
		printk("%s\n", mma7660_pola[pola]);
	}

	shake = (val >> 5) & 0x01;
	if (shake && shake != ((last_tilt >> 5) & 0x01)) {
		printk("Shake\n");
	}

	tap = (val >> 7) & 0x01;
	if (tap && tap != ((last_tilt >> 7) & 0x01)) {
		printk("Tap\n");
	}

	/* Save current status */
	last_tilt = val;
	
	int axis[3];
	int i;
	for (i = 0; i < 3; i++)
	{
		mma7660_read_xyz(mma7660_client, i, &axis[i]);
	}
	printk("ABS_X=%d\n",axis[0]);
	printk("ABS_Y=%d\n",axis[1]);
	printk("ABS_Z=%d\n",axis[2]);
}


/*
函数功能: mma7660初始化
*/
static int mma7660_initialize(struct i2c_client *client)
{
	int val;

	/* Using test mode to probe chip */
	i2c_smbus_write_byte_data(client, MMA7660_MODE, 0x00);
	mdelay(10);
	i2c_smbus_write_byte_data(client, MMA7660_MODE, 0x04);
	mdelay(10);
	i2c_smbus_write_byte_data(client, MMA7660_XOUT, 0x3f);
	i2c_smbus_write_byte_data(client, MMA7660_YOUT, 0x01);
	i2c_smbus_write_byte_data(client, MMA7660_ZOUT, 0x15);
	val = i2c_smbus_read_byte_data(client, MMA7660_ZOUT);
	if (val != 0x15) {
		dev_err(&client->dev, "no device\n");
		return -ENODEV;
	}

	/* Goto standby mode for configuration */
	i2c_smbus_write_byte_data(client, MMA7660_MODE, 0x00);
	mdelay(10);

	/* Sample rate: 64Hz / 16Hz; Filt: 3 samples  */
	i2c_smbus_write_byte_data(client, MMA7660_SR, ((2<<5) | (1<<3) | 1));

	/* Sleep count */
	i2c_smbus_write_byte_data(client, MMA7660_SPCNT, 0xA0);

	/* Tap detect and debounce ~4ms */
	i2c_smbus_write_byte_data(client, MMA7660_PDET, 4);
	i2c_smbus_write_byte_data(client, MMA7660_PD, 15);

	/* Enable interrupt except exiting Auto-Sleep */
	i2c_smbus_write_byte_data(client, MMA7660_INTSU, 0xe7);

	/* IPP, Auto-wake, auto-sleep and standby */
	i2c_smbus_write_byte_data(client, MMA7660_MODE, 0x59);
	mdelay(10);

	/* Save current tilt status */
	mma7660_read_tilt(client, &last_tilt);

	mma7660_client = client;
	return 0;
}


/*
静态方式初始化工作队列
*/
DECLARE_WORK(mma7660_work,mma7660_worker);
static irqreturn_t mma7660_interrupt(int irq, void *dev_id)
{
	/*调度共享工作队列*/
	schedule_work(&mma7660_work);
	return IRQ_HANDLED;
}


/*
匹配成功时调用
*/
static int mma7660_probe(struct i2c_client *client, const struct i2c_device_id *device_id)
{
	printk("mma7660_probe!!!\n");
	printk("驱动端IIC匹配的地址=0x%x\n",client->addr);
	
	mma7660_client=client;
	
	/*1. 注册中断*/
	mma7660_irq=gpio_to_irq(client->irq);/*获取中断编号*/
    if(request_irq(mma7660_irq,mma7660_interrupt,IRQF_TRIGGER_FALLING,"mma7660_irq",NULL)!=0)
    {
		printk("mma7660_中断注册失败!\n");
	}
	
	/*2. 初始化mma7660*/
	if(mma7660_initialize(client) < 0)
	{
		printk(" 初始化mma7660失败!\n");
	}
    return 0;
}


static int mma7660_remove(struct i2c_client *client)
{
	free_irq(mma7660_irq,NULL);
	printk("mma7660_remove!!!\n");
	return 0;
}


struct i2c_driver i2c_drv =
{
	.driver =
	{
		.name = "mma7660",
		.owner = THIS_MODULE,
	},	
	.probe = mma7660_probe,   //探测函数
	.remove = mma7660_remove, //资源卸载
	.id_table = mma7660_id,   //里面有一个名字的参数用来匹配设备端名字
};


static int __init mma7660_drv_init(void)
{
	/*向iic总线注册一个驱动*/
	i2c_add_driver(&i2c_drv);
	return 0;
}

static void __exit mma7660_drv_exit(void)
{
	/*从iic总线注销一个驱动*/
	i2c_del_driver(&i2c_drv);
}

module_init(mma7660_drv_init);
module_exit(mma7660_drv_exit);
MODULE_LICENSE("GPL");
【版权声明】本文为华为云社区用户原创内容,转载时必须标注文章的来源(华为云社区)、文章链接、文章作者等基本信息, 否则作者和本社区有权追究责任。如果您发现本社区中有涉嫌抄袭的内容,欢迎发送邮件进行举报,并提供相关证据,一经查实,本社区将立刻删除涉嫌侵权内容,举报邮箱: cloudbbs@huaweicloud.com
  • 点赞
  • 收藏
  • 关注作者

评论(0

0/1000
抱歉,系统识别当前为高风险访问,暂不支持该操作

全部回复

上滑加载中

设置昵称

在此一键设置昵称,即可参与社区互动!

*长度不超过10个汉字或20个英文字符,设置后3个月内不可修改。

*长度不超过10个汉字或20个英文字符,设置后3个月内不可修改。