N76E003 HMC5883

HMC5883.c

#include "N76E003.h"
#include "Common.h"
#include "Delay.h"
#include "SFR_Macro.h"
#include "Function_define.h"
#include "HMC5883.h"

#include  <math.h>    //Keil library  
#include  <stdlib.h>  //Keil library  
#include  <stdio.h>   //Keil library	
#include  <INTRINS.H> //Keil library 


#define   uchar unsigned char
#define   uint unsigned int	
#define		SlaveAddress   0x3C  //定義器件在IIC總線中的從位址


uchar BUF[8];//接收資料緩存區      	
uchar gew,shiw,baiw,qianw,wanw;           //顯示變量
 double angle;
//int  dis_data;                       //變量

void Init_HMC5883(void);            //初始化5883
void WriteDataLCM(uchar dataW);
void WriteCommandLCM(uchar CMD,uchar Attribc);
void DisplayOneChar(uchar X,uchar Y,uchar DData);
void conversion(uint temp_data);
void  Single_Write_HMC5883(uchar REG_Address,uchar REG_data);   //單個寫入資料
uchar Single_Read_HMC5883(uchar REG_Address);                   //單個讀取内部寄存器資料
void  Multiple_Read_HMC5883();                                  //連續的讀取内部寄存器資料
//以下是模拟iic使用函數-------------
void HMC5883_Start();
void HMC5883_Stop();
void HMC5883_SendACK(bit ack);
bit  HMC5883_RecvACK();
void HMC5883_SendByte(uchar dat);
uchar HMC5883_RecvByte();
void HMC5883_ReadPage();
void HMC5883_WritePage();
//-----------------------------------


void Delay51us() //5us延時(不怎麼準）
{
    nop;
 nop; nop; nop; nop; nop; nop; nop; nop;
	    nop;
 nop; nop; nop; nop; nop; nop; nop; nop;
	    nop;
 nop; nop; nop; nop; nop; nop; nop; nop;
	    nop;
 nop; nop; nop; nop; nop; nop; nop; nop;
	    nop;
 nop; nop; nop; nop; nop; nop; nop; nop;
}


//*********************************************************
void conversion(uint temp_data)  
{  
    wanw=temp_data/10000+0x30 ;
    temp_data=temp_data%10000;   //取餘運算
		qianw=temp_data/1000+0x30 ;
    temp_data=temp_data%1000;    //取餘運算
    baiw=temp_data/100+0x30   ;
    temp_data=temp_data%100;     //取餘運算
    shiw=temp_data/10+0x30    ;
    temp_data=temp_data%10;      //取餘運算
    gew=temp_data+0x30; 	
}
					

/**************************************
起始信号
**************************************/
void HMC5883_Start()
{
    SDA= 1;                    //拉高資料線
    SCL = 1;                    //拉高時鐘線
    Delay51us();                 //延時
    SDA = 0;                    //産生下降沿
    Delay51us();                 //延時
    SCL = 0;                    //拉低時鐘線
}

/**************************************
停止信号
**************************************/
void HMC5883_Stop()
{
    SDA = 0;                    //拉低資料線
    SCL = 1;                    //拉高時鐘線
    Delay51us();                 //延時
    SDA = 1;                    //産生上升沿
    Delay51us();                 //延時
}

/**************************************
發送應答信号
入口參數:ack (0:ACK 1:NAK)
**************************************/
void HMC5883_SendACK(bit ack)
{
    SDA = ack;                  //寫應答信号
    SCL = 1;                    //拉高時鐘線
    Delay51us();                 //延時
    SCL = 0;                    //拉低時鐘線
    Delay51us();                 //延時
}

/**************************************
接收應答信号
**************************************/
bit HMC5883_RecvACK()
{
    SCL = 1;                    //拉高時鐘線
    Delay51us();                 //延時
    CY = SDA;                   //讀應答信号
    SCL = 0;                    //拉低時鐘線
    Delay51us();                 //延時

    return CY;
}

/**************************************
向IIC總線發送一個位元組資料
**************************************/
void HMC5883_SendByte(uchar dat)
{
    uchar i;

    for (i=0; i<8; i++)         //8位計數器
    {
        dat <<= 1;              //移出資料的最高位
        SDA = CY;               //送資料口
        SCL = 1;                //拉高時鐘線
        Delay51us();             //延時
        SCL = 0;                //拉低時鐘線
        Delay51us();             //延時
    }
    HMC5883_RecvACK();
}

/**************************************
從IIC總線接收一個位元組資料
**************************************/
uchar HMC5883_RecvByte()
{
    uchar i;
    uchar dat = 0;

    SDA = 1;                    //使能内部上拉,準備讀取資料,
    for (i=0; i<8; i++)         //8位計數器
    {
        dat <<= 1;
        SCL = 1;                //拉高時鐘線
        Delay51us();             //延時
        dat |= SDA;             //讀資料               
        SCL = 0;                //拉低時鐘線
        Delay51us();             //延時
    }
    return dat;
}

//***************************************************

void Single_Write_HMC5883(uchar REG_Address,uchar REG_data)
{
    HMC5883_Start();                  //起始信号
    HMC5883_SendByte(SlaveAddress);   //發送裝置位址+寫信号
    HMC5883_SendByte(REG_Address);    //内部寄存器位址，請參考中文pdf 
    HMC5883_SendByte(REG_data);       //内部寄存器資料，請參考中文pdf
    HMC5883_Stop();                   //發送停止信号
}

//********單位元組讀取内部寄存器*************************
uchar Single_Read_HMC5883(uchar REG_Address)
{  	
		uchar REG_data;
    HMC5883_Start();                          //起始信号
    HMC5883_SendByte(SlaveAddress);           //發送裝置位址+寫信号
    HMC5883_SendByte(REG_Address);                   //發送存儲單元位址，從0開始	
    HMC5883_Start();                          //起始信号
    HMC5883_SendByte(SlaveAddress+1);         //發送裝置位址+讀信号
    REG_data=HMC5883_RecvByte();              //讀出寄存器資料
		HMC5883_SendACK(1);   
		HMC5883_Stop();                           //停止信号
    return REG_data; 
}
//******************************************************
//
//連續讀出HMC5883内部角度資料，位址範圍0x3~0x5
//
//******************************************************
void Multiple_read_HMC5883()
{   uchar i;
    HMC5883_Start();                          //起始信号
    HMC5883_SendByte(SlaveAddress);           //發送裝置位址+寫信号
    HMC5883_SendByte(0x03);                   //發送存儲單元位址，從0x3開始	
    HMC5883_Start();                          //起始信号
    HMC5883_SendByte(SlaveAddress+1);         //發送裝置位址+讀信号
		for (i=0; i<6; i++)                      //連續讀取6個位址資料，存儲中BUF
    {
        BUF[i] = HMC5883_RecvByte();          //BUF[0]存儲資料
        if (i == 5)
        {
           HMC5883_SendACK(1);                //最後一個資料需要回NOACK
        }
        else
        {
          HMC5883_SendACK(0);                //回應ACK
       }
   }
    HMC5883_Stop();                          //停止信号
		Timer0_Delay1ms(5);
}

//初始化HMC5883，根據需要請參考pdf進行修改****
void Init_HMC5883()
{
   Single_Write_HMC5883(0x02,0x00);  
}


void EC()//Electronic compass
{ 
    int x,y,z;
   
//    Delay_1ms(500);
		Timer0_Delay1ms(500);

    Multiple_Read_HMC5883();      //連續讀出資料，存儲在BUF中
    x=BUF[0] << 8 | BUF[1]; //Combine MSB and LSB of X Data output register
    z=BUF[2] << 8 | BUF[3]; //Combine MSB and LSB of Z Data output register
    y=BUF[4] << 8 | BUF[5]; //Combine MSB and LSB of Y Data output register
    angle= atan2((double)y,(double)x) * (180 / 3.14159265) + 180; // angle in degrees
    angle*=10;
    conversion(angle);       //計算資料和顯示                   
} 
           

HMC5883.h

#ifndef _HMC5883L_h_
#define _HMC5883L_h_


extern unsigned char gew,shiw,baiw,qianw,wanw;
extern  double angle;
void EC();//Electronic compass
void Init_HMC5883();//初始化程式，放在大循環前

#endif