zoukankan      html  css  js  c++  java
  • 驱动程序实例(六):mpu6050(IIC + cdev)

    在我们实际开发中,I2C 总线驱动一般芯片原厂会提供,我们开发一般是设计设备驱动。

    本文结合之前对Linux内核的IIC子系统的分析 ,以及对字符设备的cdev接口的分析,本文将编写基于IIC总线与cdev接口的MPU6050设备的实例代码并对其进行分析。

    IIC子系统分析:详见Linux IIC总线驱动框架

    字符设备的cdev接口分析:详见Linux字符设备驱动(一):cdev接口

    硬件接口:

      CPU:s5pv210;

      挂载IIC总线编号:0。

    IIC从设备驱动挂载在IIC总线下,IIC总线管理着IIC从设备的设备信息(i2c_client)与设备驱动(i2c_driver)。因此,IIC从设备驱动的编写分为两个部分:注册IIC从设备信息、编写IIC从设备驱动程序。

    在设备驱动程序中使用IIC总线,需确保Linux内核支持IIC。在menuconfig下做如下设置接口。

      Device Drivers  --->

        <*> I2C support  --->  

    1. 注册IIC从设备信息

    在/kernel/arch/arm/mach-s5pv210/mach-x210.c文件中添加如下信息,向Linux内核注册IIC从设备信息。

    static struct i2c_board_info mpu6050_i2c_devs0[] __initdata = 
    {
        {
            I2C_BOARD_INFO("mpu6050", 0x2b),//构建i2c_board_info结构体,0x2b为从设备的地址
        },
    };
    
    
    static void __init smdkc110_machine_init(void)
    {
        ... ...
        i2c_register_board_info(0, mpu6050_i2c_devs0, ARRAY_SIZE(mpu6050_i2c_devs0));//向内核注册IIC从设备信息,0表示该从设备挂载在IIC总线适配器0
        ... ...
    }    

    2. 编写IIC从设备驱动程序

    (1)mpu6050_common.h

    将mpu6050_common.h文件添加至/kernel/drivers/i2c/busses目录下。

    #ifndef _MPU6050_COMMON_H_
    #define _MPU6050_COMMON_H_
    
    #define MPU6050_MAGIC 'K'
    
    //mpu6050数据结构
    union mpu6050_data
    {
        struct {
            short x;
            short y;
            short z;
        }accel;
        struct {
            short x;
            short y;
            short z;
        }gyro;
        unsigned short temp;
    };
    
    //mpu6050的ioctl的命令定义
    #define GET_ACCEL _IOR(MPU6050_MAGIC, 0, union mpu6050_data)//读取加速度计的数据
    #define GET_GYRO  _IOR(MPU6050_MAGIC, 1, union mpu6050_data)//读取陀螺仪的数据 
    #define GET_TEMP  _IOR(MPU6050_MAGIC, 2, union mpu6050_data)//读取温度的数据
    
    #endif
    mpu6050_common.h

    (2)mpu6050_dev.h

    mpu6050_dev.h文件是mpu6050的寄存器地址的定义文件,将其添加至添加至/kernel/drivers/i2c/busses目录下。

    #ifndef _MPU6050_DEV_H_
    #define _MPU6050_DEV_H_
    
    #define SMPLRT_DIV      0x19    //陀螺仪采样率,典型值:0x07(125Hz)
    #define CONFIG          0x1A    //低通滤波频率,典型值:0x06(5Hz)
    #define GYRO_CONFIG     0x1B    //陀螺仪自检及测量范围,典型值:0x18(不自检,2000deg/s)
    #define ACCEL_CONFIG    0x1C    //加速计自检、测量范围及高通滤波,典型值:0x18(不自检,2G,5Hz)
    #define ACCEL_XOUT_H    0x3B
    #define ACCEL_XOUT_L    0x3C
    #define ACCEL_YOUT_H    0x3D
    #define ACCEL_YOUT_L    0x3E
    #define ACCEL_ZOUT_H    0x3F
    #define ACCEL_ZOUT_L    0x40
    #define TEMP_OUT_H      0x41
    #define TEMP_OUT_L      0x42
    #define GYRO_XOUT_H     0x43
    #define GYRO_XOUT_L     0x44
    #define GYRO_YOUT_H     0x45
    #define GYRO_YOUT_L     0x46
    #define GYRO_ZOUT_H     0x47    //陀螺仪z轴角速度数据寄存器(高位)
    #define GYRO_ZOUT_L     0x48    //陀螺仪z轴角速度数据寄存器(低位)
    #define PWR_MGMT_1      0x6B    //电源管理,典型值:0x00(正常启用)
    #define WHO_AM_I        0x75    //IIC地址寄存器(默认数值0x68,只读)
    #define SlaveAddress    0x68    //MPU6050-I2C地址寄存器
    
    #endif
    mpu6050_dev.h

    (3)mpu6050.c

    #include <linux/module.h>
    #include <linux/init.h>
    #include <linux/kernel.h>
    #include <linux/fs.h>
    #include <linux/device.h>
    #include <linux/i2c.h>
    #include <linux/uaccess.h>
    #include <linux/usb.h>
    #include <linux/cdev.h>
    
    #include "mpu6050_dev.h"
    #include "mpu6050_common.h"
    
    
    #define DEV_MINOR 100       //IIC从设备的起始次设备号
    #define DEV_CNT 1           //IIC从设备的个数
    #define DEV_NAME "mpu6050"  //IIC从设备名称
    
    static struct i2c_client *mpu6050_client;
    
    static struct cdev mpu6050_dev;
    static dev_t mpu6050_devnum;       //设备号
    static struct class *mpu6050_class;//设备类
    
    /*
    *    功能:向mpu6050从设备写入数据
    *
    *    参数:struct i2c_client *client:指向mpu6050从设备
    *          const unsigned char reg:需写入的mpu6050的寄存器
    *          const unsigned char val:写入的数值
    */
    static void mpu6050_write_byte(struct i2c_client *client, const unsigned char reg, const unsigned char val)
    { 
        char txbuf[2] = {reg, val};//数据缓存buffer
        
        //封装msg
        struct i2c_msg msg[2] = {
        
            [0] = 
            {
                .addr = client->addr,
                .flags= 0,
                .len = sizeof(txbuf),
                .buf = txbuf,
            },
        };
        
        i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));//与从设备进行数据通信
    }
    
    
    /*
    *    功能:向mpu6050从设备读取数据
    *
    *    参数:struct i2c_client *client:指向mpu6050从设备
    *          const unsigned char reg:需读取的mpu6050的寄存器
    *
    *    返回值:char:读取的数据
    */
    static char mpu6050_read_byte(struct i2c_client *client,const unsigned char reg)
    {
        char txbuf[1] = {reg};//数据缓冲buffer
        char rxbuf[1] = {0};
        
        //封装msg
        struct i2c_msg msg[2] = 
        {
            [0] = 
            {
                .addr = client->addr,
                .flags = 0,
                .len = sizeof(txbuf),
                .buf = txbuf,
            },
            
            [1] = 
            {
                .addr = client->addr,
                .flags = I2C_M_RD,
                .len = sizeof(rxbuf),
                .buf = rxbuf,
            },
        };
    
        i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); //与从设备进行数据通信
        
        return rxbuf[0];
    }
    
    //mpu6050硬件初始化
    static void mpu6050_init(struct i2c_client *client)
    {
        mpu6050_write_byte(client, PWR_MGMT_1, 0x00);
        mpu6050_write_byte(client, SMPLRT_DIV, 0x07);
        mpu6050_write_byte(client, CONFIG, 0x06);
        mpu6050_write_byte(client, GYRO_CONFIG, 0x18);
        mpu6050_write_byte(client, ACCEL_CONFIG, 0x0);
    }
    
    
    static int mpu6050_open(struct inode *ip, struct file *fp)
    {
        return 0;
    }
    static int mpu6050_release(struct inode *ip, struct file *fp)
    {
        return 0;
    }
    
    static long mpu6050_ioctl(struct file *fp, unsigned int cmd, unsigned long arg)
    {
        int res = 0;
        union mpu6050_data data = {{0}};
        
        switch(cmd)
        {
            //读取加速度计的数据
            case GET_ACCEL:
                data.accel.x = mpu6050_read_byte(mpu6050_client,ACCEL_XOUT_L);
                data.accel.x|= mpu6050_read_byte(mpu6050_client,ACCEL_XOUT_H)<<8;
                data.accel.y = mpu6050_read_byte(mpu6050_client,ACCEL_YOUT_L);
                data.accel.y|= mpu6050_read_byte(mpu6050_client,ACCEL_YOUT_H)<<8;
                data.accel.z = mpu6050_read_byte(mpu6050_client,ACCEL_ZOUT_L);
                data.accel.z|= mpu6050_read_byte(mpu6050_client,ACCEL_ZOUT_H)<<8;
                break;
            
            //读取陀螺仪的数据
            case GET_GYRO:
                data.gyro.x = mpu6050_read_byte(mpu6050_client,GYRO_XOUT_L);
                data.gyro.x|= mpu6050_read_byte(mpu6050_client,GYRO_XOUT_H)<<8;
                data.gyro.y = mpu6050_read_byte(mpu6050_client,GYRO_YOUT_L);
                data.gyro.y|= mpu6050_read_byte(mpu6050_client,GYRO_YOUT_H)<<8;
                data.gyro.z = mpu6050_read_byte(mpu6050_client,GYRO_ZOUT_L);
                data.gyro.z|= mpu6050_read_byte(mpu6050_client,GYRO_ZOUT_H)<<8;
                printk("gyro:x %d, y:%d, z:%d
    ",data.gyro.x,data.gyro.y,data.gyro.z);
                break;
            
            //读取温度的数据
            case GET_TEMP:
                data.temp = mpu6050_read_byte(mpu6050_client,TEMP_OUT_L);
                data.temp|= mpu6050_read_byte(mpu6050_client,TEMP_OUT_H)<<8;
                printk("temp: %d
    ",data.temp);
                break;
                
            default:
                printk(KERN_INFO "invalid cmd");
                break;
        }
        printk("acc:x %d, y:%d, z:%d
    ",data.accel.x,data.accel.y,data.accel.z);
        res = copy_to_user((void *)arg,&data,sizeof(data));
        return sizeof(data);
    }
    
    //mpu6050操作集
    static const struct file_operations mpu6050_fops = 
    {
        .owner = THIS_MODULE,
        .open  = mpu6050_open,
        .release = mpu6050_release,
        .unlocked_ioctl = mpu6050_ioctl,
    };
    
    static int mpu6050_probe(struct i2c_client *client, const struct i2c_device_id *id)
    {
        struct device *dev;
        
        mpu6050_client = client;
        
        /*****************************初始化硬件设备******************************/
        //初始化mpu6050
        mpu6050_init(client);
        
        dbg("probe:name = %s,flag =%d,addr = %d,adapter = %d,driver = %s
    ", client->name,
             client->flags,client->addr,client->adapter->nr,client->driver->driver.name );
        
        /*********************************创建接口********************************/
        cdev_init(&mpu6050_dev, &mpu6050_fops);                            //关联dev与fops
        alloc_chrdev_region(&mpu6050_devnum, DEV_MINOR, DEV_CNT, DEV_NAME);//自动分配设备号
        cdev_add(&mpu6050_dev, mpu6050_devnum, DEV_CNT);                   //添加设备至设备链表
        
        mpu6050_class = class_create(THIS_MODULE,DEV_NAME);                         //创建设备类
        dev = device_create(mpu6050_class, NULL , mpu6050_devnum, "%s%d", DEV_NAME);//创建mpu6050设备
        if (IS_ERR(dev))
        {
            dbg("device create error
    ");
            goto out;
        }
        
        return 0;
    out:
        return -1;
    }
    
    static int  mpu6050_remove(struct i2c_client *client)
    {
        dbg("remove
    ");
        
        device_destroy(mpu6050_class, mpu6050_devnum);
        class_destroy(mpu6050_class);
        unregister_chrdev_region(mpu6050_devnum,DEV_CNT);
        
        return 0;
    }
    
    //与mpu6050的设备信息匹配
    static struct i2c_device_id mpu6050_ids[] = 
    {
        {"mpu6050",0x2b},
        {}
    };
    
    //声明mpu6050_ids是i2c类型的一个设备表
    MODULE_DEVICE_TABLE(i2c,mpu6050_ids);
    
    //定义并初始化从设备驱动信息
    static struct i2c_driver mpu6050_driver = 
    {
        .probe    = mpu6050_probe,
        .remove   = mpu6050_remove,
        .id_table = mpu6050_ids,
        .driver = 
        {
            .name = "mpu6050",
            .owner = THIS_MODULE,
        },
    };
    
    static int __init mpu6050_i2c_init(void)
    {
        return i2c_add_driver(&mpu6050_driver);//注册设备驱动
    }
    
    
    static void __exit mpu6050_i2c_exit(void)
    {
        i2c_del_driver(&mpu6050_driver);       //注销设备驱动
    }
    
     
    MODULE_AUTHOR("Lin");
    MODULE_DESCRIPTION("mpu6050 driver");
    MODULE_LICENSE("GPL");
    module_init(mpu6050_i2c_init);
    module_exit(mpu6050_i2c_exit);
  • 相关阅读:
    destoon手机端mobileurl函数增加城市分类参数
    jCarousel,jQuery下的滚动切换传送插件
    jQuery plugin : bgStretcher 背景图片切换效果插件
    jquery图片切换插件jquery.cycle.js参数详解
    destoon 后台管理左侧新增菜单项
    destoon 列表页面增加手动选择排序方式
    jQuery 淡入淡出有png图的时候 ie8下有黑色边框
    java中Array和ArrayList区别
    趣味理解ADO.NET对象模型
    两个datatable的比较
  • 原文地址:https://www.cnblogs.com/linfeng-learning/p/9532338.html
Copyright © 2011-2022 走看看