智能车学习(十一)——陀螺仪学习
一、学习说明
感觉就是配置I2C通信,然后直接移植51代码。。。
二、代码分享:
1、头文件:
#ifndef I2C_GYRO_H_
#define I2C_GYRO_H_ /***********函数声明***********/ extern void Gyro_Init(void);
extern void Read_GY(void); /*****************************/ /***********全局变量声明***********/ extern float Gyro_X ;
extern float Gyro_Y ;
extern float Gyro_Z ; /*********************************/ #endif
2、源文件:
#include "include.h"
#include "common.h"
#include "gpio.h"
#include "I2C_GYRO.h"
#include "lptmr.h" /***********管脚声明***********/ #define L3G_S_I2C_SDA (PTE21)//(PTB3)//(PTE0) //(PTE22)//(PTC1)//
#define L3G_S_I2C_SCL (PTE5)//(PTB2)//(PTE1)//(PTE20)//(PTC0)// /*****************************/ //IO方向设置
#define L3G_I2C_SDA_IN() DDRE21 = 0//输入模式
#define L3G_I2C_SDA_OUT() DDRE21 = 1//输出模式 //IO操作函数
#define L3G_I2C_SCL PTE5_OUT //SCL
#define L3G_I2C_SDA PTE21_OUT //SDA
#define L3G_I2C_READ_SDA PTE21_IN //输入SDA /***********全局变量声明***********/
float Gyro_X = 0;
float Gyro_Y = 0;
float Gyro_Z = 0;
/********************************/ //**********L3G4200D内部寄存器地址*********
#define L3G_WHO_AM_I 0x0F
#define L3G_CTRL_REG1 0x20
#define L3G_CTRL_REG2 0x21
#define L3G_CTRL_REG3 0x22
#define L3G_CTRL_REG4 0x23
#define L3G_CTRL_REG5 0x24
#define L3G_REFERENCE 0x25
#define L3G_OUT_TEMP 0x26
#define L3G_STATUS_REG 0x27
#define L3G_OUT_X_L 0x28
#define L3G_OUT_X_H 0x29
#define L3G_OUT_Y_L 0x2A
#define L3G_OUT_Y_H 0x2B
#define L3G_OUT_Z_L 0x2C
#define L3G_OUT_Z_H 0x2D
#define L3G_FIFO_CTRL_REG 0x2E
#define L3G_FIFO_SRC_REG 0x2F
#define L3G_INT1_CFG 0x30
#define L3G_INT1_SRC 0x31
#define L3G_INT1_TSH_XH 0x32
#define L3G_INT1_TSH_XL 0x33
#define L3G_INT1_TSH_YH 0x34
#define L3G_INT1_TSH_YL 0x35
#define L3G_INT1_TSH_ZH 0x36
#define L3G_INT1_TSH_ZL 0x37
#define L3G_INT1_DURATION 0x38
//****************************************
#define L3G_SlaveAddress 0xD2 //定义器件在IIC总线中的从地址,根据ALT ADDRESS地址引脚不同修改
#define L3G_SlaveAddfire 0x69 //定义器件在IIC总线中的从地址,根据ALT ADDRESS地址引脚不同修改 //============================================================================
//函数名称:void L3G_I2C_Config(void)
//函数返回:无
//参数说明:无
//功能概要:配置I2C管脚
//============================================================================
void L3G_I2C_Config(void)
{
//L3G_I2C_SDA_OUT();
gpio_init(L3G_S_I2C_SDA,GPO,0);
gpio_init(L3G_S_I2C_SCL,GPO,1); L3G_I2C_SCL=1;
L3G_I2C_SDA=1;
} //============================================================================
//函数名称:void L3G_I2C_Start(void)
//函数返回:无
//参数说明:无
//功能概要:I2C启动
//============================================================================
void L3G_I2C_Start(void)
{
L3G_I2C_SDA_OUT();
L3G_I2C_SDA=1;
L3G_I2C_SCL=1;
lptmr_delay_us(1);
L3G_I2C_SDA=0;
lptmr_delay_us(1);
L3G_I2C_SCL=0;
} //============================================================================
//函数名称:void L3G_I2C_Stop(void)
//函数返回:无
//参数说明:无
//功能概要:I2C停止
//============================================================================
void L3G_I2C_Stop(void)
{
L3G_I2C_SDA_OUT();
L3G_I2C_SDA=0;
L3G_I2C_SCL=1;
lptmr_delay_us(1);
L3G_I2C_SDA=1;
lptmr_delay_us(1);
L3G_I2C_SCL=0;
} //============================================================================
//函数名称:void L3G_I2C_Mack(void)
//函数返回:无
//参数说明:无
//功能概要:
//============================================================================
void L3G_I2C_Mack(void)
{
L3G_I2C_SDA_OUT();
L3G_I2C_SDA=0;
L3G_I2C_SCL=1;
lptmr_delay_us(1);
L3G_I2C_SCL=0;
L3G_I2C_SDA=1;
} //============================================================================
//函数名称:void L3G_I2C_Mnack(void)
//函数返回:无
//参数说明:无
//功能概要:读取完的完成停顿信号
//============================================================================
void L3G_I2C_Mnack(void)
{
L3G_I2C_SDA_OUT();
L3G_I2C_SDA=1;
lptmr_delay_us(1);
L3G_I2C_SCL=1;
lptmr_delay_us(1);
L3G_I2C_SCL=0;
lptmr_delay_us(1);
//L3G_I2C_SDA=0;
} //============================================================================
//函数名称:uint8_t L3G_I2C_Cack(void)
//函数返回:无
//参数说明:无
//功能概要:发送间隔函数
//============================================================================
uint8_t L3G_I2C_Cack(void)
{
L3G_I2C_SDA_IN();
L3G_I2C_SCL=0;
lptmr_delay_us(1);
L3G_I2C_SCL=1;
lptmr_delay_us(1);
if(L3G_I2C_READ_SDA)
{
//L3G_I2C_Stop();
//return 0xff;
}
L3G_I2C_SCL=0;
L3G_I2C_SDA_OUT();
return 0;
} //============================================================================
//函数名称:void L3G_I2C_WriteByte(unsigned char data)
//函数返回:无
//参数说明:无
//功能概要:I2C发送一个字节的数据
//============================================================================
void L3G_I2C_WriteByte(unsigned char data)
{
unsigned char i=8;
L3G_I2C_SDA_OUT();
while(i--)
{
lptmr_delay_us(1);
if(data & 0x80)
L3G_I2C_SDA=1;
else
L3G_I2C_SDA=0;
lptmr_delay_us(1);
L3G_I2C_SCL=1;
lptmr_delay_us(1);
L3G_I2C_SCL=0;
data<<=1;
}
} //============================================================================
//函数名称:uint8_t L3G_I2C_ReadByte(void)
//函数返回:无
//参数说明:无
//功能概要:I2C接收一个字节的数据
//============================================================================
uint8_t L3G_I2C_ReadByte(void)
{
unsigned char i;
unsigned char data=0;
char temp;
L3G_I2C_SDA_IN();
for(i=0;i<8;i++)
{
data<<=1;
lptmr_delay_us(1);
L3G_I2C_SCL=1;
temp=L3G_I2C_READ_SDA;
if(temp)
data++;
lptmr_delay_us(1);
L3G_I2C_SCL=0;
}
return data;
} //============================================================================
//函数名称:uint8_t L3G_I2C_WR_REG(uint8_t dev_addr, uint8_t reg_addr, uint8_t writeData)
//函数返回:无
//参数说明:无
//功能概要:I2C向一个地址写一个数据
//============================================================================
uint8_t L3G_I2C_WR_REG(uint8_t dev_addr, uint8_t reg_addr, uint8_t writeData)
{
L3G_I2C_Start();
L3G_I2C_WriteByte(dev_addr);
L3G_I2C_Cack();
L3G_I2C_WriteByte(reg_addr);
L3G_I2C_Cack();
L3G_I2C_WriteByte(writeData);
L3G_I2C_Cack();
L3G_I2C_Stop(); return 0;
} //============================================================================
//函数名称:uint8_t L3G_I2C_RD_REG(uint8_t dev_addr, uint8_t reg_addr)
//函数返回:无
//参数说明:无
//功能概要:I2C从一个地址读一个数据
//============================================================================
uint8_t L3G_I2C_RD_REG(uint8_t dev_addr, uint8_t reg_addr)
{
uint8_t read_reg = 0;
L3G_I2C_Start();
L3G_I2C_WriteByte(dev_addr);
L3G_I2C_Cack();
L3G_I2C_WriteByte(reg_addr);
L3G_I2C_Cack();
L3G_I2C_Start();
L3G_I2C_WriteByte(dev_addr + 1);
L3G_I2C_Cack();
read_reg = L3G_I2C_ReadByte();
L3G_I2C_Mnack();
L3G_I2C_Stop(); return read_reg;
} //============================================================================
//函数名称:uint8_t L3G_I2C_RD_Buffer(uint8_t dev_addr, uint8_t reg_addr, uint8_t data_num, uint8_t *readBuffer)
//函数返回:无
//参数说明:无
//功能概要:I2C向一个地址写一连串数据
//============================================================================
uint8_t L3G_I2C_RD_Buffer(uint8_t dev_addr, uint8_t reg_addr, uint8_t data_num, uint8_t *readBuffer)
{
uint8_t i = 0;
L3G_I2C_Start();
L3G_I2C_WriteByte(dev_addr);
L3G_I2C_Cack();
L3G_I2C_WriteByte(reg_addr);
L3G_I2C_Cack();
L3G_I2C_Start();
L3G_I2C_WriteByte(dev_addr + 1);
L3G_I2C_Cack(); for(i = 0; i < data_num; i++){
*(readBuffer+i) = L3G_I2C_ReadByte();
if(i == data_num - 1)
L3G_I2C_Mnack();
else
L3G_I2C_Mack();
}
L3G_I2C_Stop(); return 0;
} //============================================================================
//函数名称:void Gyro_Init( __RAMFUNC void)
//函数返回:无
//参数说明:无
//功能概要://初始化为指定模式
//============================================================================
void Gyro_Init(void)
{
L3G_I2C_Config();
L3G_I2C_WR_REG(L3G_SlaveAddress,L3G_CTRL_REG1,0xcf); //数据手册30 0xbf 400hz 20~110截止频率
L3G_I2C_WR_REG(L3G_SlaveAddress,L3G_CTRL_REG2,0x20);//前两位00,后两位高通滤波器模式选择,后四位截止频率 0x29
L3G_I2C_WR_REG(L3G_SlaveAddress,L3G_CTRL_REG3,0x00);
L3G_I2C_WR_REG(L3G_SlaveAddress,L3G_CTRL_REG4,0x30);
L3G_I2C_WR_REG(L3G_SlaveAddress,L3G_CTRL_REG5,0x00);
} //============================================================================
//函数名称:void Read_GY(void)
//函数返回:无
//参数说明:无
//功能概要:陀螺仪传感器测量值读取接口
//============================================================================ uint8_t tmpBuffer[6] = {0}; void Read_GY(void)
{
//int16_t x_h = 0,x_l = 0,y_l = 0,y_h = 0,z_h = 0,z_l = 0;//Gyro_X = 0,Gyro_Y = 0,Gyro_Z = 0;
//Gyro_Init();
L3G_I2C_RD_Buffer(L3G_SlaveAddress,0xA8,6,tmpBuffer); /*
Gyro_X = ((short)((tmpBuffer[1]<<8)|tmpBuffer[0]))>>2;// 14位精度 Gyro_Y = ((short)((tmpBuffer[3]<<8)|tmpBuffer[2]))>>2;// 14位精度 Gyro_Z = ((short)((tmpBuffer[5]<<8)|tmpBuffer[4]))>>2;// 14位精度
*/ int temp; temp = ((short)((tmpBuffer[1]<<8)|tmpBuffer[0]))>>4;//2;// 14位精度 1g数值为1024(原本为4096,但是右移了(无效位2位)(有效位14位)两位)
Gyro_X = (double)Gyro_X*0.5+(double)temp*0.5; temp = ((short)((tmpBuffer[3]<<8)|tmpBuffer[2]))>>4;//2;// 14位精度
Gyro_Y = (double)Gyro_Y*0.5+(double)temp*0.5; temp = ((short)((tmpBuffer[5]<<8)|tmpBuffer[4]))>>4;//2;// 14位精度
Gyro_Z = (double)Gyro_Z*0.5+(double)temp*0.5;
}
智能车学习(十一)——陀螺仪学习的更多相关文章
- 智能车学习(十五)——K60野火2013版例程
一.中断函数注册方法: 1.格式: 配置某个功能的中断 注册中断函数 开启中断 2.一个例子 pit_init_ms(PIT0,);//定时中断初始化 set_vector_handler(PIT0_ ...
- 201521123061 《Java程序设计》第十一周学习总结
201521123061 <Java程序设计>第十一周学习总结 1. 本周学习总结 1.1 以你喜欢的方式(思维导图或其他)归纳总结多线程相关内容. 本周学习的是如何解决多线程访问中的互斥 ...
- 201521123072《java程序设计》第十一周学习总结
201521123072<java程序设计>第十一周学习总结 1. 本周学习总结 2. 书面作业 本次PTA作业题集多线程 互斥访问与同步访问 完成题集4-4(互斥访问)与4-5(同步访问 ...
- 201521123038 《Java程序设计》 第十一周学习总结
201521123038 <Java程序设计> 第十一周学习总结 1. 本周学习总结 1.1 以你喜欢的方式(思维导图或其他)归纳总结多线程相关内容. 2. 书面作业 本次PTA作业题集多 ...
- 杨其菊/常惠琢《面向对象程序设计(java)》第十一周学习总结
<面向对象程序设计>第十一周学习总结 第一部分:理论知识 JAVA的集合框架 JAVA的集合框架实现对各种数据结构的封装,以降低对数据管理与处理的难度. 所谓框架就是一个类库的集合,框 ...
- 【转载】 强化学习(十一) Prioritized Replay DQN
原文地址: https://www.cnblogs.com/pinard/p/9797695.html ------------------------------------------------ ...
- “2017面向对象程序设计(Java)第十一周学习总结”存在问题的反馈及教学安排
“2017面向对象程序设计(Java)第十一周学习总结”存在问题的反馈及教学安排1.“提出表扬的同学:姜依萍,王雪玲,徐楠,相文君,赵晓未提交作业的同学:任红强,王瑞强,宗鹏新,扎西才让,布旦刀杰,范 ...
- 20172325 2017-2018-2 《Java程序设计》第十一周学习总结
20172325 2017-2018-2 <Java程序设计>第十一周学习总结 教材学习内容总结 Android简介 Android操作系统是一种多用户的Linux系统,每个应用程序作为单 ...
- 20172330 2017-2018-1 《Java程序设计》第十一周学习总结
20172330 2017-2018-1 <程序设计与数据结构>第十一周学习总结 教材学习内容总结 本周的学习内容为集合 Android简介 Android操作系统是一种多用户的Linux ...
- 孤荷凌寒自学python第八十一天学习爬取图片1
孤荷凌寒自学python第八十一天学习爬取图片1 (完整学习过程屏幕记录视频地址在文末) 通过前面十天的学习,我已经基本了解了通过requests模块来与网站服务器进行交互的方法,也知道了Beauti ...
随机推荐
- Qt Connect 信号 槽
信号和槽机制是 QT 的核心机制 .信号和槽是一种高级接口,应用于对象之间的通信,它是 QT 的核心特性,也是 QT 区别于其它工具包的重要地方.信号和槽是 QT 自行定义的一种通信机制,它独立于标准 ...
- C++中Cstring、wstring 和string互相转换总结
通过前一篇文章<C++中string,wstring,CString的基本概念和用法>,对Cstring.wstring 和string有了一个了解.string是C++提供的标准字符串操 ...
- rabbitMQ中vhost虚拟主机的理解
每个virtual host本质上都是一个RabbitMQ Server,拥有它自己的queue,exchagne,和bings rule等等.这保证了你可以在多个不同的application中使用R ...
- ACM/ICPC 之 BFS-广搜+队列入门-抓牛(POJ3278)
这一题是练习广度优先搜索很好的例题,在很多广搜教学中经常用到,放在这里供学习搜索算法的孩纸们看看= = 题目大意:一维数轴上,农夫在N点,牛在K点,假定牛不会移动,农夫要找到这头牛只能够进行以下三种移 ...
- 9.SpringMVC和json结合传递数据 && 10.SpringMVC获取controller中json的数据
- Django~NewProject and APP
New Project 1.新建 django-admin startproject mysite 2.运行 manage.py runserver 8080 New APP 1.manage.py ...
- struts配置文件中如何从一个package的action跳到另一个package中的某个action
<package name="pack1" namespace="/test1" extends="struts-default"&g ...
- bootstrap弹出提示窗口功能
大家常用弹出提示成功或失败时候喜欢用alert,如果不用这个,写个弹窗又麻烦,bootstrap中就有个方法 alert("操作成功"); commonAlert("操作 ...
- Eclipse的使用及Java程序的标识符和关键字
Eclipse的使用 (1)创建Java项目 选择“文件”/“新建”/“Java项目”命令,在弹出的“新建Java项目”对话框输入项目名,然后点击“下一步”,最后单击“完成”. (2)创建Java类文 ...
- Linux常用的日志分析命令与工具
>>基础命令 操作 命令 说明 查看文件的内容 cat -n access.log -n显示行号 分页显示文件 more access.log Enter下一行,空格下一页,F下一屏,B上 ...