#include "SC7A22H.h"
#include "mk_trace.h"



//ÂÖѯ»ñÈ¡ÈýÖáÊý¾ÝʾÀý
void SC7A22H_get_rawdata_Polling()
{
    signed short SL_Read_Buf[3]={0};
    signed short SL_XYZ_Data[3]={0};
    unsigned char reg_value=0;
		uint8_t data;
		uint8_t buff[6];
//1.³õʼ»¯Í¨ÐŽӿÚ
    SL_SC7A22H_I2c_Spi_Init(SL_SC7A22H_SPI_IIC_MODE);

//2.¸´Î»Ð¾Æ¬
    SL_SC7A22H_Soft_Reset();
		SL_SC7A22H_Delay_Ms(1000);
		
//3.¼ì²éÊÇ·ñÄܶÁȡоƬWHO AM I¼Ä´æÆ÷		
	  SL_SC7A22H_Check();

//4.Æô¶¯ACC	
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x7F, 0x00);//goto 0x00
  SL_SC7A22H_Delay_Ms(10);	
	  SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x7D, 0x04);//PWR_CTRL ENABLE ACC		
	  SL_SC7A22H_Delay_Ms(10);	
	 	
//5.ÉèÖÃÁ¿³Ì	
	  SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x41, 0x01);//ACC_RANGE  ¡À4G	

//6.ÉèÖÃÊä³öËÙÂʸüС¢¹¤×÷ģʽ	
    SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x40, 0x07);//ACC_CONF 50Hz  ¸ßÐÔÄÜ		
	  SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x05, 0x50);//I2C_CFG	
		
	
    while(1)
    {
		SL_SC7A22H_Delay_Ms(1000);
//7.Ñ­»·¶ÁÈ¡¼ÓËÙ¶ÈÊý¾Ý
		SL_SC7A22H_RawData_Read(&gsensor_soft_fifo_buffer[0].sXAxisVal, &gsensor_soft_fifo_buffer[0].sYAxisVal, &gsensor_soft_fifo_buffer[0].sZAxisVal);
			
			}
 
}

uint8_t fifo_ready_flag=0;

/***************FIFOģʽ»ñÈ¡XYZÊý¾ÝˮλʾÀý*********/
void SC7A22H_get_rawdata_fifo_wtm_interrupt()
{
    signed short SL_Read_Buf[3]={0};
    signed short SL_XYZ_Data[3]={0};
    unsigned char reg_value=0;
		uint8_t data;
		uint8_t FIFO_stat;
		uint8_t buff[6];
//1.³õʼ»¯Í¨ÐŽӿÚ
   SL_SC7A22H_I2c_Spi_Init(SL_SC7A22H_SPI_IIC_MODE);

//2.¸´Î»Ð¾Æ¬
    SL_SC7A22H_Soft_Reset();//ÎÞÎÊÌâ
		
//3.¼ì²éÊÇ·ñÄܶÁȡоƬWHO AM I¼Ä´æÆ÷		
	  SL_SC7A22H_Check();//ÎÞÎÊÌâ

//4.Æô¶¯ACC		
    SL_SC7A22H_I2c_Spi_Write(SL_SC7A22H_SPI_IIC_MODE, 0x7D, 0x04);//PWR_CTRL ENABLE ACC
    SL_SC7A22H_Delay_Ms(15);
		
//5.ÉèÖÃÁ¿³Ì	
	  SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x41, 0x01);//ACC_RANGE  ¡À4G	

					
//6.FIFOģʽ
    SL_SC7A22H_I2c_Spi_Read(SL_SPI_IIC_INTERFACE, 0x05, 1, &reg_value);
		reg_value=reg_value&0xEF;//addr_add_auto disable
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x05, reg_value);  
//AOI1 ÖжÏ×÷Ϊ FIFO ´¥·¢Ä£Ê½ÖжÏʼþÊäÈ룬FIFOģʽ
    SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x1D, 0x10);//fifo mode set
//WTM ãÐÖµÉèÖÃ:	75	
    SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x1E, 0x4B);//fifo fth set	 
//FIFOʹÄÜ
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x1C, 0x04);//fifo enable

//7.ÖжÏÅäÖà  int1Öжϴ¥·¢Ê±Êä³ö¸ßµçƽ£¨Ä¬Èϵ͵çƽ£©, FIFOˮλÖжÏÔÚ INT1 ÉÏ
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x06, 0x09);//INT_CFG1 	

//8.ÉèÖÃÊä³öËÙÂʸüС¢¹¤×÷ģʽ	
    SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x40, 0x06);//ACC_CONF 25Hz  µÍ¹¦ºÄģʽ			
		
    fifo_ready_flag=0;
    while(1)
    {
			if(fifo_ready_flag)
			{
			
				fifo_ready_flag=0;
			  SL_SC7A22H_FIFO_Read(&gsensor_soft_fifo_buffer[0].sXAxisVal, &gsensor_soft_fifo_buffer[0].sYAxisVal, &gsensor_soft_fifo_buffer[0].sZAxisVal);

			}
    }
}

//Óû§Ðè×Ô¶¨ÒåÖжϷþÎñº¯Êý£¬µ±FIFOÊý¾ÝÂúʱINT1»á´ÓµÍµçƽ±äΪ¸ßµçƽ£¬Óû§¿ÉÒÔIO²¶×½ÉÏÉýÑزúÉúÖжÏ
//ÔÚÆäÖжϷþÎñÖе÷Óøĺ¯Êý
void fifo_ready_interrupt_callback()
{
	fifo_ready_flag=1;
}



uint8_t double_click_flag=0;
/*******Ë«»÷¼ì²âʾÀý*********/
void SC7A22H_get_double_click()
{
    unsigned char reg_value=0;
		unsigned char CLICK_status;
//1.³õʼ»¯Í¨ÐŽӿÚ
   SL_SC7A22H_I2c_Spi_Init(SL_SC7A22H_SPI_IIC_MODE);

//2.¸´Î»Ð¾Æ¬
    SL_SC7A22H_Soft_Reset();//ÎÞÎÊÌâ
		
//3.¼ì²éÊÇ·ñÄܶÁȡоƬWHO AM I¼Ä´æÆ÷		
	  SL_SC7A22H_Check();//ÎÞÎÊÌâ
		
//4,¼ÓËٶȼÆʹÄÜ
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x7D, 0x04);//PWR_CTRL ENABLE ACC
		SL_SC7A22H_Delay_Ms(200);
		
//5,Á¿³ÌÉèÖãº+-4G
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x41, 0x01);//ACC_RANGE  ¡À4G
	
//6£¬Çû÷ÖжÏÉèÖÃ
//Êä³öÊý¾Ý¼Ä´æÆ÷²»¸üÐÂÖ±µ½ MSB ºÍ LSB ±»¶ÁÈ¡ 2,µØÖ·×ÔÔö£¬Á¬Ðø¶ÁдʱµØÖ·×ÔÔö
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x05, 0x50);//I2C_CFG
//ÍÆÍìÊä³öʹÄÜ,	Öжϴ¥·¢Ê±Êä³ö¸ßµçƽ£¨Ä¬Èϵ͵çƽ£©£¬CLICK ÖжÏÔÚ INT1 ÉÏ	
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x06, 0x07);//INT_CFG1 CLICK TO INT1
//½ûÖ¹Â˲¨
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x08, 0x00);//Disable DLPF
//AOI ÖжÏʹÄÜ£¬AOI1Â˲¨Ê¹ÄÜ£¬Ëø´æ AOI1_CFG ¼Ä´æÆ÷ÉÏÖ¸¶¨µÄÖжÏÏìÓ¦
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x3F, 0x11);//HPIS1=1 LIR_AOI1
//XYZ Öá¸ßʼþÖжϻòÕß Z Öá·½Ïò¼ì²âÖжÏʹÄÜ£¬
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x30, 0x2A);//xyz for aoi1 or event
//AIO1ãÐÖµ£º4G----32mg*8=256mg
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x32, 0x08);//aoi1 vth
//ʶ±ðAIO1ʼþµÄ×îС³ÖÐøʱ¼ä
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x33, 0x02);//aoi1 tth
	
//7£¬Çû÷ÅäÖÃ
//ÐèÒª½«0x7F£¨SEG_SEL£©ÅäÖÃ0x90ºóÔÙ½øÐзÃÎʵļĴæÆ÷¼°µØÖ·ºÍ³õÖµÆ÷
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x7F, 0x90);//goto 0x90
		SL_SC7A22H_Delay_Ms(1);			
//Êä³öÖжϱØÐëÂú×ãÉèÖõÄÇû÷ãÐÖµ¸öÊý²ÅÄÜÊä³öÖжϣ¬·ñÔòÎÞÖжÏÊä³ö
//Ëø´æCLICK ÖжÏ״̬,£ºÊ¹ÄÜ XYZ ÖáÊý¾Ý²ÎÓëÇû÷¼ì²â
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x38, 0x1F);//XYZ CLICK ENABLE  AND LATCH INT LEVEL				
	//Çû÷Ç°Êý¾ÝÎȶ¨Ê±³¤ÉèÖÃ------20ms£¨400hz£©
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x40, 0x52);//CLICK_COEFF1
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x41, 0x9A);//CLICK_COEFF2
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x42, 0x04);//CLICK_COEFF3
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x43, 0x52);//CLICK_COEFF4  //0x52ÖеÄ2±íʾÇû÷´ÎÊý
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x7F, 0x00);//goto 0x00
		SL_SC7A22H_Delay_Ms(1);	
//8£¬µÍ¹¦ºÄģʽʹÄÜ  400HzÊä³ö	
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x40, 0x0A);//ACC_CONF 0x0A=400Hz
//9, ¶ÁÈ¡CLICK_SRCµÄ״̬»ú
   SL_SC7A22H_I2c_Spi_Read(SL_SC7A22H_SPI_IIC_MODE, 0x39, 1, &CLICK_status);

//µÈ´ýÖжϴ¥·¢
   double_click_flag=0;
    while(1)
    {
			if(double_click_flag)
			{
				 double_click_flag=0;		
         SL_SC7A22H_I2c_Spi_Read(SL_SC7A22H_SPI_IIC_MODE, 0x39, 1, &CLICK_status);
			   printf("SC7A22H_INT1_SRC:%x\r\n",CLICK_status);
				
			}
						
    }
}


//Óû§Ðè×Ô¶¨ÒåÖжϷþÎñº¯Êý£¬µ±Ô˶¯¼ì²âʼþ´¥·¢Ê±INT1»á´Ó¸ßµçƽ±äΪµÍµçƽ£¬Óû§¿ÉÒÔIO²¶×½Ï½µÑزúÉúÖжÏ
//ÔÚÆäÖжϷþÎñÖе÷Óøĺ¯Êý
void double_click_interrupt_callback()
{ 
  double_click_flag=1;
}



/***************¼Æ²½¼ì²âʾÀý*********/
uint8_t Pedo_flag=0;
void SC7A22H_get_Pedo()
{
    unsigned char reg_value=0;
		unsigned char Pedo_status;
    unsigned int  Pedo_Count;
//1.³õʼ»¯Í¨ÐŽӿÚ
   SL_SC7A22H_I2c_Spi_Init(SL_SC7A22H_SPI_IIC_MODE);
//2.¸´Î»Ð¾Æ¬
    SL_SC7A22H_Soft_Reset();//ÎÞÎÊÌâ		
//3.¼ì²éÊÇ·ñÄܶÁȡоƬWHO AM I¼Ä´æÆ÷		
//	  SL_SC7A22H_Check();//ÎÞÎÊÌâ		
//4,¼ÓËٶȼÆʹÄÜ
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x7D, 0x04);//PWR_CTRL ENABLE ACC
		SL_SC7A22H_Delay_Ms(200);		
//5,Á¿³ÌÉèÖãº+-4G
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x41, 0x01);//ACC_RANGE  ¡À4G
//6£¬ÖжÏÉèÖÃ
//Êä³öÊý¾Ý¼Ä´æÆ÷²»¸üÐÂÖ±µ½ MSB ºÍ LSB ±»¶ÁÈ¡ 2,µØÖ·×ÔÔö£¬Á¬Ðø¶ÁдʱµØÖ·×ÔÔö
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x05, 0x50);//I2C_CFG		
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x06, 0x10);//DELTA_STEP ÖжÏÔÚ INT1 ÉÏ				
//Æô¶¯Â˲¨
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x08, 0x05);//Enable DLPF
	
//7£¬¼Æ²½ÉèÖÃ
  SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x7F, 0x90);
	SL_SC7A22H_Delay_Ms(1);
	//¿¹Âí´ïºÍÒôÀÖ¸ÉÈÅʹÄÜ,¼Æ²½¹¦ÄÜʹÄÜ
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x3A, 0x05);
	//¼Æ²½Ä£¿éÂ˲¨Æ÷ÉèÖÃ
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x46, 0x4F);
	//¼Æ²½ÁéÃô¶È:100,×îÓżƲ½Öáʱ¼äãÐÖµÉèÖÃ:11
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x47, 0x23);			
	//×î¼ÑÊý¾ÝÔ´Çл»ãÐÖµÉèÖãº00£¬Æðʼ²½ÊýÉèÖãº100£¬¹æÂɼƲ½µÈ¼¶£º011
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x48, 0x8F);
	//µ¥²½ãÐÖµÏÂÏÞ¿ØÖÆ:100  ,µ¥²½ãÐÖµÉÏÏÞ¿ØÖÆ:101
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x49, 0x1C);	
	//XYZ ²ÎÓë¼Æ²½,¼Æ²½ÔëÉù:0100
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x4A, 0x04);
	//ÔëÉù¼ÆÊýãÐÖµÉèÖÃ:100
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x4B, 0x8C);
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x7F, 0x00);
	SL_SC7A22H_Delay_Ms(1); 
//8£¬µÍ¹¦ºÄģʽʹÄÜ  50HzÊä³ö	
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x40, 0x26);////ACC_CONF 0x07=50Hz

//µÈ´ýÖжϴ¥·¢
   Pedo_flag=0;

}
uint8_t pedo_upload_count=0;
uint8_t pedo_upload_status=0;
extern uint8_t Pedo_flag;
void SC7A22H_get_Pedo_task()
{
			if(Pedo_flag)
			{
			 Pedo_flag=0;
       pedo_upload_status=SL_SC7A22H_Get_Motion();				
       pedo_upload_count=SL_SC7A22H_Get_Pedo_Count();
			 LOG_INFO(TRACE_MODULE_APP,"SC7A22H_Pedo_status:%d\r\n",pedo_upload_status);
			 LOG_INFO(TRACE_MODULE_APP,"SC7A22H_Pedo_Count:%d\r\n",pedo_upload_count);
			}

}

//¼Æ²½¹¦ÄÜÆô¶¯º¯Êý

//Óû§Ðè×Ô¶¨ÒåÖжϷþÎñº¯Êý£¬µ±Ô˶¯¼ì²âʼþ´¥·¢Ê±INT1»á´Ó¸ßµçƽ±äΪµÍµçƽ£¬Óû§¿ÉÒÔIO²¶×½Ï½µÑزúÉúÖжÏ
//ÔÚÆäÖжϷþÎñÖе÷Óøĺ¯Êý
void Pedo_interrupt_callback()
{ 
  Pedo_flag=1;
}



/***************̧Íó¼ì²âʾÀý*********/
uint8_t Wrist_flag=0;
void SC7A22H_get_Wrist()
{
    unsigned char reg_value=0;
		unsigned char Wrist_status;
    unsigned int Wrist_Count;
//1.³õʼ»¯Í¨ÐŽӿÚ
   SL_SC7A22H_I2c_Spi_Init(SL_SC7A22H_SPI_IIC_MODE);

//2.¸´Î»Ð¾Æ¬
    SL_SC7A22H_Soft_Reset();//ÎÞÎÊÌâ
		
//3.¼ì²éÊÇ·ñÄܶÁȡоƬWHO AM I¼Ä´æÆ÷		
	  SL_SC7A22H_Check();//ÎÞÎÊÌâ
		
//4,¼ÓËٶȼÆʹÄÜ
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x7D, 0x04);//PWR_CTRL ENABLE ACC
		SL_SC7A22H_Delay_Ms(200);
		
//5,Á¿³ÌÉèÖãº+-4G
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x41, 0x01);//ACC_RANGE  ¡À4G
	
//6£¬ÖжÏÉèÖÃ
//Êä³öÊý¾Ý¼Ä´æÆ÷²»¸üÐÂÖ±µ½ MSB ºÍ LSB ±»¶ÁÈ¡ 2,µØÖ·×ÔÔö£¬Á¬Ðø¶ÁдʱµØÖ·×ÔÔö
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x05, 0x50);//I2C_CFG		
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x06, 0x15);//WRIST_ON_FLAG|WRIST_DOWN_FLAG ÖжÏÔÚ INT1 ÉÏ				
//Æô¶¯Â˲¨
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x08, 0x05);//Enable DLPF
	
//7£¬Ì§ÍóÉèÖÃ
  SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x7F, 0x90);
  SL_SC7A22H_Delay_Ms(1);
  SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x7F, 0x90);
	SL_SC7A22H_Delay_Ms(1);
	//ÊÖÍó¼ì²âʹÄÜ
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x3E, 0x10);
	//ÔÊÐí½Ç¶ÈÎó²îÉèÖÃ:16LSB, ÌùƬλÖÃÉèÖãºÕýÃ溸½ÓλÖÃ3
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x51, 0x33);
	//̧ÊÖÄ¿±ê½Ç¶ÈÖµÉèÖÃλ:¶ÔÓ¦¼ÓËÙ¶ÈÖµ4
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x52, 0x02);
	//̧ÊÖʶ±ðÁéÃô¶ÈÉèÖãº16LSB£¬Ì§ÊÖ״̬´¥·¢ËùÐè³ÖÐøʱ¼äµÄÉèÖãº0.4s,À뿪̧ÊÖ״̬´¥·¢ËùÐè³ÖÐøʱ¼ä:0.4s
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x53, 0x93);	
	SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE,0x7F, 0x00);
	SL_SC7A22H_Delay_Ms(1);
//8£¬µÍ¹¦ºÄģʽʹÄÜ  50HzÊä³ö	
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x40, 0x26);////ACC_CONF 0x07=50Hz
//µÈ´ýÖжϴ¥·¢
  Wrist_flag=0;
    while(1)
    {
			if(Wrist_flag)
			{
			 Wrist_flag=0;
			 Wrist_status=SL_SC7A22H_Get_Wrist_Status();

			}
						
    }
}


//Óû§Ðè×Ô¶¨ÒåÖжϷþÎñº¯Êý£¬µ±Ô˶¯¼ì²âʼþ´¥·¢Ê±INT1»á´Ó¸ßµçƽ±äΪµÍµçƽ£¬Óû§¿ÉÒÔIO²¶×½Ï½µÑزúÉúÖжÏ
//ÔÚÆäÖжϷþÎñÖе÷Óøĺ¯Êý
void Wrist_interrupt_callback()
{ 
  Wrist_flag=1;
}






void SC7A22H_self_test()
{
    signed short SL_Read_Buf[3]={0};
    signed short SL_XYZ_Data[3]={0};
    unsigned char reg_value=0;
		uint8_t data;
		uint8_t buff[6];
//1.³õʼ»¯Í¨ÐŽӿÚ
   SL_SC7A22H_I2c_Spi_Init(SL_SC7A22H_SPI_IIC_MODE);
//2.¸´Î»Ð¾Æ¬
    SL_SC7A22H_Soft_Reset();//ÎÞÎÊÌâ		
//3.¼ì²éÊÇ·ñÄܶÁȡоƬWHO AM I¼Ä´æÆ÷		
	  SL_SC7A22H_Check();//ÎÞÎÊÌâ	
//¼ÓËٶȼÆʹÄÜ
    SL_SC7A22H_I2c_Spi_Write(SL_SC7A22H_SPI_IIC_MODE, 0x7D, 0x04);//¼ÓËٶȼÆʹÄÜ
    delay_ms(15);		
//µÍ¹¦ºÄģʽʹÄÜ, µÍ¹¦ºÄģʽ:1¸öÊý¾Ýƽ¾ùÒ»´Î£¬50HzÊä³ö	
  
//È«Á¿³ÌÑ¡Ôñ:¡À8G		
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x41, 0x02);//ACC_RANGE  ¡À8G
    SL_SC7A22H_I2c_Spi_Read(SL_SC7A22H_SPI_IIC_MODE, 0x6D, 1, &reg_value);
		delay_ms(60);  
				
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x40, 0xac);//ACC_CONF 0x07=50Hz				
	delay_ms(60); 
//µØÖ·×ÔÔö£¬Á¬Ðø¶ÁдʱµØÖ·×ÔÔö,Á¬Ðø¸üÐÂ
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x05, 0x10);//I2C_CFG
    delay_ms(60); 
//		SL_SC7A22H_I2c_Spi_Read(SL_SC7A22H_SPI_IIC_MODE, 0x6D, 1, &reg_value);
//×Ô²âÊÔģʽʹÄÜ---Õý·½Ïò£¬	ƫתµÍÕñ·ù			
		SL_SC7A22H_I2c_Spi_Write(SL_SPI_IIC_INTERFACE, 0x6D, 0x05);//

   delay_ms(60);    
    while(1)
    {

			SL_SC7A22H_RawData_Read(&gsensor_soft_fifo_buffer[0].sXAxisVal, &gsensor_soft_fifo_buffer[0].sYAxisVal, &gsensor_soft_fifo_buffer[0].sZAxisVal);
			
			delay_ms(1000);
    }
}