HMC5883电子罗盘数据输出,STM32代码
大家好,我是KDX,前几天 刚测试使用了HMC5883电子罗盘模块,自己对
这东西也不熟,当时也是到处找代码,自己测试时总出现输出角度一直是45°的情况,后来终于调出来了,现将代码分享一下。
首先是 .H文件
#ifndef _HMC5883L_H
#define _HMC5883L_H#include "sys.h"#define SlaveAddress 0X3C //HMC5883L从机地址//IO方向设置,寄存器操作,比库函数稍微快点
#define SDA_IN() {GPIOC->CRH&=0XFFFF0FFF;GPIOC->CRH|=8<<12;}
#define SDA_OUT() {GPIOC->CRH&=0XFFFF0FFF;GPIOC->CRH|=3<<12;}
//CRL:GPIO_0~GPIO_7 CRH:GPIO_8~GPIO_15
//每个单片机端口占据着CRL/CRH的四个位//IO操作函数
#define IIC_SCL PCout(12) //SCL
#define IIC_SDA PCout(11) //SDA
#define READ_SDA PCin(11) //输入SDA //IIC所有操作函数
void GY_IIC_Delay(void); //MPU IIC延时函数
void GY_IIC_Init(void); //初始化IIC的IO口
void GY_IIC_Start(void); //发送IIC开始信号
void GY_IIC_Stop(void); //发送IIC停止信号
void GY_IIC_Send_Byte(u8 txd); //IIC发送一个字节
u8 GY_IIC_Read_Byte(unsigned char ack);//IIC读取一个字节
u8 GY_IIC_Wait_Ack(void); //IIC等待ACK信号
void GY_IIC_Ack(void); //IIC发送ACK信号
void GY_IIC_NAck(void); //IIC不发送ACK信号u8 HMC5883_SB_Read(u8 Slave_Address, u8 Register_Address) ;
u8 HMC5883_SB_Write(u8 Slave_Address, u8 Register_Address, u8 Register_Data) ;
void HMC5883_Init(void) ;
float HMC5883_Get_Angle(void) ;#endif
然后是HMC5883L
#include "hmc5883l.h"
#include "math.h"
#include "delay.h"extern short HMC_X,HMC_Y,HMC_Z; //HMC5883三轴数据输出//==============================模拟IIC函数区=====================================
void GY_IIC_Delay(void)
{delay_us(2);
}//初始化IIC
void GY_IIC_Init(void)
{ GPIO_InitTypeDef GPIO_InitStructure;RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC,ENABLE);//先使能外设IO PORTC时钟 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12|GPIO_Pin_11; // 端口配置GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //推挽输出GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; //IO口速度为50MHzGPIO_Init(GPIOC, &GPIO_InitStructure); //根据设定参数初始化GPIO GPIO_SetBits(GPIOC,GPIO_Pin_12|GPIO_Pin_11); //PB10,PB11 输出高 }
//产生IIC起始信号
void GY_IIC_Start(void)
{SDA_OUT(); //sda线输出IIC_SDA=1; IIC_SCL=1;GY_IIC_Delay();IIC_SDA=0;//START:when CLK is high,DATA change form high to low GY_IIC_Delay();IIC_SCL=0;//钳住I2C总线,准备发送或接收数据
}
//产生IIC停止信号
void GY_IIC_Stop(void)
{SDA_OUT();//sda线输出IIC_SCL=0;IIC_SDA=0;//STOP:when CLK is high DATA change form low to highGY_IIC_Delay();IIC_SCL=1; IIC_SDA=1;//发送I2C总线结束信号GY_IIC_Delay();
}
//等待应答信号到来
//返回值:1,接收应答失败
// 0,接收应答成功
u8 GY_IIC_Wait_Ack(void)
{u8 ucErrTime=0;SDA_IN(); //SDA设置为输入 IIC_SDA=1;GY_IIC_Delay(); IIC_SCL=1;GY_IIC_Delay(); while(READ_SDA){ucErrTime++;if(ucErrTime>250){GY_IIC_Stop();return 1;}}IIC_SCL=0;//时钟输出0 return 0;
}
//产生ACK应答
void GY_IIC_Ack(void)
{IIC_SCL=0;SDA_OUT();IIC_SDA=0;GY_IIC_Delay();IIC_SCL=1;GY_IIC_Delay();IIC_SCL=0;
}
//不产生ACK应答
void GY_IIC_NAck(void)
{IIC_SCL=0;SDA_OUT();IIC_SDA=1;GY_IIC_Delay();IIC_SCL=1;GY_IIC_Delay();IIC_SCL=0;
}
//IIC发送一个字节
//返回从机有无应答
//1,有应答
//0,无应答
void GY_IIC_Send_Byte(u8 txd)
{ u8 t; SDA_OUT(); IIC_SCL=0;//拉低时钟开始数据传输for(t=0;t<8;t++){ IIC_SDA=(txd&0x80)>>7;txd<<=1; IIC_SCL=1;GY_IIC_Delay(); IIC_SCL=0; GY_IIC_Delay();}
}
//读1个字节,ack=1时,发送ACK,ack=0,发送nACK
u8 GY_IIC_Read_Byte(unsigned char ack)
{unsigned char i,receive=0;SDA_IN();//SDA设置为输入for(i=0;i<8;i++ ){IIC_SCL=0; GY_IIC_Delay();IIC_SCL=1;receive<<=1;if(READ_SDA)receive++; GY_IIC_Delay(); } if (!ack)GY_IIC_NAck();//发送nACKelseGY_IIC_Ack(); //发送ACK return receive;
}//==================================模拟IIC-END==============================//==========================HMC5883函数定义=============================u8 HMC5883_SB_Read(u8 Slave_Address, u8 Register_Address)
{static u8 Res_Data = 0;GY_IIC_Start(); GY_IIC_Send_Byte(Slave_Address);//0X3C GY_IIC_Wait_Ack(); //等待应答 GY_IIC_Send_Byte(Register_Address); //寄存器地址GY_IIC_Wait_Ack(); //等待应答GY_IIC_Start();GY_IIC_Send_Byte(Slave_Address + 1);//0X3D GY_IIC_Wait_Ack(); //等待应答 Res_Data=GY_IIC_Read_Byte(0);//读取数据,发送nACK GY_IIC_Stop(); //产生一个停止条件 return Res_Data;
}u8 HMC5883_SB_Write(u8 Slave_Address, u8 Register_Address, u8 Register_Data)
{GY_IIC_Start(); GY_IIC_Send_Byte(Slave_Address);//发送设备地址if(GY_IIC_Wait_Ack()) //等待应答{GY_IIC_Stop(); return 1; }GY_IIC_Send_Byte(Register_Address); //写寄存器地址GY_IIC_Wait_Ack(); //等待应答 GY_IIC_Send_Byte(Register_Data); //发送数据if(GY_IIC_Wait_Ack()) //等待ACK{GY_IIC_Stop(); return 1; } GY_IIC_Stop(); return 0;}void HMC5883_Init(void)
{GY_IIC_Init() ;HMC5883_SB_Write(SlaveAddress, 0X00, 0X58); //写寄存器A,30Hz数据输出、采样平均数0HMC5883_SB_Write(SlaveAddress, 0X01, 0X40); //写寄存器B,传感器量程+-0.88Ga、增益1370高斯HMC5883_SB_Write(SlaveAddress, 0X02, 0X00); //写寄存器C,连续数据输出}float HMC5883_Get_Angle(void)
{u8 i ;float Angle ;short Recive_Data[6] ; //store temperary dataHMC5883_Init() ;for(i=0; i<6; i++){Recive_Data[i] = HMC5883_SB_Read(SlaveAddress, i+3) ; //get data}HMC_X = Recive_Data[0]<<8 | Recive_Data[1];//Combine MSB and LSB of X Data output registerHMC_Z = Recive_Data[2]<<8 | Recive_Data[3];//Combine MSB and LSB of Z Data output registerHMC_Y = Recive_Data[4]<<8 | Recive_Data[5];//Combine MSB and LSB of Y Data output registerAngle= atan2((double)HMC_Y,(double)HMC_X) * (180 / 3.14159265) + 180; // angle in degreesreturn Angle ;
}```c
在这里插入代码片
在使用的时候,直接调用HMC5883_Get_Angle() ;就行了,不过好像这个模块容易受周边环境的影响,比如金属材料。不过可能也是自己代码没搞好,欢迎各位指正。
HMC5883电子罗盘数据输出,STM32代码相关推荐
- dataframe 输出标题_【学界】第八章:Python代码之数据输出、调参与算法总结
作者:小杨 学校:广东工业大学 年级:研二 专业:工业工程 主要研究兴趣:强化学习.深度学习 简介:作者是广东工业大学2016级工业工程系研究生,师从广东工业大学教授.博士生导师.<工业工程&g ...
- STM32+MAX6675 获取4路温度数据原理图及代码
STM32+MAX6675 获取4路温度数据原理图及代码 说明:1.片选任意IO管脚即可,低电平有效! 2.K型热电偶分别接T+,T-: 3.介于STM32只读,就只用3根线,SO,SCL,CS 见图 ...
- STM32+MAX6675利用io口模拟SPI获取实时温度数据程序及代码
STM32+MAX6675利用io口模拟SPI获取实时温度数据程序及代码 本文采用的芯片为STM32F103RCT6 温度芯片为MAX6675 因为芯片的spi口只有3个,有部分需要外接W25Q128 ...
- STM32+MAX6675利用SPI获取实时温度数据程序及代码
之前写的STM32+MAX6675利用io口模拟SPI获取实时温度数据程序及代码 本文采用的芯片为STM32F103RCT6 温度芯片为MAX6675 模拟spi之前写过 里面的部分代码摘取的正点原子 ...
- Python---pyspark中的数据输出(collect,reduce,take,count,saveAsTextFile),了解PySpark代码在大数据集群上运行
1. Spark的编程流程就是: 将数据加载为RDD(数据输入) 对RDD进行计算(数据计算) 将RDD转换为Python对象(数据输出) 2. 数据输出的方法 将RDD的结果输出为Python对象的 ...
- 程序运行时对应的内存分布(BSS段、数据段、代码段、堆、栈)关系
参考:程序运行时对应的内存分布关系 作者:嵌入式基地(公众号) 发布时间: 2021-04-28 网址:https://mp.weixin.qq.com/s/AVDPZawSjg9HtxEm8vsFB ...
- Shiny平台构建与R包开发(三)——数据输出
作为Shiny平台构建与R包开发教程的第三小节,本节向读者展示如何利用Shiny server输出自己想要的数据,包括Rplot.Table.Text等信息. 数据输出机制 仍以上一节的案例为基础: ...
- 修改vb6的编译器c2.exe使它可以输出汇编代码_xv6笔记-启动代码分析
首先看xv6 commit的第一个makefile OBJS = main.o CC = i386-jos-elf-gcc LD = i386-jos-elf-ld OBJCOPY = i386-jo ...
- BC26通过LWM2M协议连接ONENET,AT流程,STM32代码
onenet平台操作 登录onenet后,进入控制台 选择NB-IoT物联网套件 新建产品 产品名字.类别根据自己情况填,协议选择LWM2M 产品新建成功 点击产品名字,进入产品详情 给产品添加设备 ...
最新文章
- Object.keys方法之详解
- Could not GET “XXXXX.xml”Received status code 400
- vs开发人员命令查看C++类 data member 内存布局
- Index of Oracle
- MVC+EF三层+抽象工厂
- numpy 中shape的用法
- mongodb 导出时间格式_MongoDB批量将时间戳转为通用日期格式示例代码 _ 蚂蚁视界...
- CookieHelper
- 苹果回应大数据杀熟:罪在开发者,和苹果没关系!
- 设置返回IOS开发(26)之UITableView的页眉和页脚
- QI认证BPP,EPP,PPDE区别
- Arcgis学习视频教程
- GoF总结-18(状态模式)
- tcp图片13包java怎么接收_13. TCP协议中的动态数据传输:应对小数据包
- 安卓手机怎么删除html文件,安卓手机如何打开和删除7z文件?
- [瓦尔登湖]一颗璀璨的明珠
- virtualbox虚机硬盘扩容
- Symantec赛门铁克官网下载地址
- 爬美女图的的脚本分享, 灯灯灯噔....
- 八卦和天干地支的正确读音