#include "BMP390.h"
//#include "stm32l0xx_hal_gpio.h"
#include "main.h"
#include <stdio.h>
#define Offest_Pressure 0

 //³õʼ»¯I2C
void IIC_Init(void)
{					     
//	GPIO_InitTypeDef GPIO_InitStructure;
//	RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);
//	   
//	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_13|GPIO_Pin_15;
//	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP ;
//	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
//	GPIO_Init(GPIOB, &GPIO_InitStructure);
//	GPIO_SetBits(GPIOB,GPIO_Pin_13|GPIO_Pin_15); 	//SET the Pins to high level

    GPIO_InitTypeDef GPIO_InitStructure= {0};
    __HAL_RCC_GPIOA_CLK_ENABLE();
	GPIO_InitStructure.Pin = GPIO_PIN_2|GPIO_PIN_3;
	GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_OD ;   //ÍÆÍìÊä³ö
	GPIO_InitStructure.Speed = GPIO_SPEED_FREQ_HIGH;
	HAL_GPIO_Init(GPIOA, &GPIO_InitStructure);
	HAL_GPIO_WritePin(GPIOA,GPIO_PIN_2|GPIO_PIN_3,GPIO_PIN_SET); 	//PB6,PB7 Êä³ö¸ß
}
//²úÉúI2CÆðʼÐźÅ(¼´STARTÐźÅ)
void IIC_Start(void)
{
//		IIC2_SDA_OUT();     //sdaÏßÊä³ö
		BMP390_SDA_1;
//		delay_us(10);	
		BMP390_SCL_1;
		delay_us(10);
		BMP390_SDA_0;//START:when CLK is high,DATA change form high to low
		delay_us(10);
		BMP390_SCL_0;//ǯסI2C×ÜÏߣ¬×¼±¸·¢ËÍ»ò½ÓÊÕÊý¾Ý 
}	  
//²úÉúI2CÍ£Ö¹ÐźÅ(¼´STOPÐźÅ)
void IIC_Stop(void)
{
//		IIC2_SDA_OUT();//sdaÏßÊä³ö
		BMP390_SCL_0;
//		delay_us(10);
		BMP390_SDA_0;//STOP:when CLK is high DATA change form low to high
	 	delay_us(10);
		BMP390_SCL_1; 
//		delay_us(10);
		BMP390_SDA_1;//·¢ËÍI2C×ÜÏß½áÊøÐźÅ
		delay_us(10);							   	
}
//µÈ´ýÓ¦´ðÐźÅ
//·µ»ØÖµ£º1£¬½ÓÊÕÓ¦´ðʧ°Ü
//        0£¬½ÓÊÕÓ¦´ð³É¹¦
u8 IIC_Wait_Ack(void)
{
	uint8_t ucErrTime=0;
//  IIC2_SDA_IN();      //SDAÉèÖÃΪÊäÈë
 	BMP390_SDA_1;
	delay_us(1);	   
	BMP390_SCL_1;
	delay_us(1);	

	while(BMP390_IIC2_READ_SDA)
	{
		ucErrTime++;
		if(ucErrTime>250)
		{
			IIC_Stop();
			return 1;
		}
	}
	BMP390_SCL_0;//ʱÖÓÊä³ö0
	return 0;  
} 
//²úÉúACKÓ¦´ðÐźÅ
void IIC_Ack(void)
{
	BMP390_SCL_0;
//	IIC2_SDA_OUT();
	BMP390_SDA_0;
	delay_us(10);
	BMP390_SCL_1;
	delay_us(10);
	BMP390_SCL_0;
}
//²»²úÉúACKÓ¦´ðÐźÅ	    
void IIC_NAck(void)
{
	BMP390_SCL_0;
//	IIC2_SDA_OUT();
	BMP390_SDA_1;
	delay_us(10);
	BMP390_SCL_1;
	delay_us(10);
	BMP390_SCL_0;
}					 				     
//I2C·¢ËÍÒ»¸ö×Ö½Ú
//·µ»Ø´Ó»úÓÐÎÞÓ¦´ð
//1£¬ÓÐÓ¦´ð
//0£¬ÎÞÓ¦´ð		  
void IIC_Send_Byte(u8 txd)
{                        
    uint8_t t;   
//		IIC2_SDA_OUT();
		BMP390_SCL_0;//À­µÍʱÖÓ¿ªÊ¼Êý¾Ý´«Êä
    for(t=0;t<8;t++)
    {              
			if((txd&0x80)>>7)
			{
				BMP390_SDA_1;
			}
			else
			{
				BMP390_SDA_0;
			}
        
		txd <<= 1;
		delay_us(10);
		BMP390_SCL_1;
		delay_us(10);
		BMP390_SCL_0;
		delay_us(10);
    } 
} 	    
//¶Á1¸ö×Ö½Ú£¬ack=1ʱ£¬·¢ËÍACK£¬ack=0ʱ£¬·¢ËÍnACK 
u8 IIC_Read_Byte(unsigned char ack)
{
	unsigned char i,receive=0;
//	SDA_IN();//SDAÉèÖÃΪÊäÈë
    for(i=0;i<8;i++ )
	{
    BMP390_SCL_0; 
    delay_us(10);
		BMP390_SCL_1;
    receive<<=1;
    if(BMP390_IIC2_READ_SDA)receive++;   
		delay_us(5); 
    }					 
    if (!ack)
        IIC_NAck();//·¢ËÍnACK
    else
        IIC_Ack(); //·¢ËÍACK   
    return receive;
}


void BMP390_Write_Byte(u8 addr,u8 data)
{
  IIC_Start();
	IIC_Send_Byte(BMP390_Write);
	IIC_Wait_Ack();
	IIC_Send_Byte(addr);
	IIC_Wait_Ack();
	IIC_Send_Byte(data);
	IIC_Wait_Ack();
	IIC_Stop();
}
 
u8 BMP390_Read_Byte(u8 addr)
{
	u8 BMP390_Data;
	
	IIC_Start();
	IIC_Send_Byte(BMP390_Write);
	IIC_Wait_Ack();
	IIC_Send_Byte(addr);
	IIC_Wait_Ack();
 
	IIC_Start();// start again
	IIC_Send_Byte(BMP390_Read);
	IIC_Wait_Ack();
	BMP390_Data = IIC_Read_Byte(0);
	IIC_Stop();
	return BMP390_Data;
}
u8 BMP390_Init(void)
{
	u8 BMP390_ID,temp;
//    IIC_Start();
//    IIC_Send_Byte(BMP390_Write);
//    IIC_Send_Byte(0xB6);
//    IIC_Stop();
	BMP390_Write_Byte(CMD_Addr,0xB6);//RESET
	delay_ms(100);
	BMP390_ID = BMP390_Read_Byte(CHIP_ID_Addr);//Read the CHIP_ID-0x60
    printf("BMP390_ID:%d",BMP390_ID);
	BMP390_Write_Byte(PWR_CTRL_Addr,0x33);//Set Working mode and state of sensor
//	BMP390_Write_Byte(IF_CONF_Addr,0x00);//Serial interface settings
	BMP390_Write_Byte(INT_CTRL_Addr,0x02);//Set interrupt config
	
	temp = BMP3_OVERSAMPLING_2X<<3|BMP3_OVERSAMPLING_32X;
	BMP390_Write_Byte(OSR_Addr,temp);//Set the PM-RATE and PM-PRC,Set the TMPI-RATE and TMP-PRC
	temp = BMP3_ODR_6_25_HZ;
	BMP390_Write_Byte(ODR_Addr,temp);//Set the configuration of the output data rates by means of setting the subdivision/subsampling.
	temp = BMP3_IIR_FILTER_COEFF_3<<1;
	BMP390_Write_Byte(CONFIG_Addr,temp);//IIR filter coeffcients
	return BMP390_ID;
}
 
u32 Temperature_Read(void)
{
	u8 Temp_MSB,Temp_CSB,Temp_LSB;
	u32 Temperature;
	Temp_MSB = BMP390_Read_Byte(TMP_B2_Addr);
	Temp_CSB = BMP390_Read_Byte(TMP_B1_Addr);
	Temp_LSB = BMP390_Read_Byte(TMP_B0_Addr);
    Temperature = (Temp_MSB<<16)+(Temp_CSB<<8)+Temp_LSB;
	return Temperature;
}
 
u32 Pressure_Read(void)
{
	u8 Pressure_MSB,Pressure_CSB,Pressure_LSB;
	u32 Pressure;
    Pressure_MSB = BMP390_Read_Byte(PSR_B2_Addr);
	Pressure_CSB = BMP390_Read_Byte(PSR_B1_Addr);
	Pressure_LSB = BMP390_Read_Byte(PSR_B0_Addr);
	Pressure = (Pressure_MSB<<16)+(Pressure_CSB<<8)+Pressure_LSB;
	return Pressure;
}
 
void Parameter_Reading(int *Pressure_Para,int *Temperature_Para)
{
	u8 Temp_Config0,Temp_Config1,Temp_Config2,Temp_Config3,Temp_Config4;
	u8 Press_Config0,Press_Config1,Press_Config2,Press_Config3,Press_Config4;
	u8 Press_Config5,Press_Config6,Press_Config7,Press_Config8,Press_Config9;
	u8 Press_Config10,Press_Config11,Press_Config12,Press_Config13,Press_Config14;
  u8 Press_Config15;	
	//Temperature coefficients
	Temp_Config0 = BMP390_Read_Byte(NVM_PAR_T1_L_Addr);
	Temp_Config1 = BMP390_Read_Byte(NVM_PAR_T1_H_Addr);
	Temp_Config2 = BMP390_Read_Byte(NVM_PAR_T2_L_Addr);
	Temp_Config3 = BMP390_Read_Byte(NVM_PAR_T2_H_Addr);
	Temp_Config4 = BMP390_Read_Byte(NVM_PAR_T3_Addr);
	Temperature_Para[0] = (Temp_Config1<<8)+Temp_Config0;//T1
	Temperature_Para[1] = (Temp_Config3<<8)+Temp_Config2;//T2
	Temperature_Para[2] = Temp_Config4;//T3
	if(Temperature_Para[2]&0x80) Temperature_Para[2] = Temperature_Para[2]-Total_Number_8;
	//Pressure coefficients
	Press_Config0 = BMP390_Read_Byte(NVM_PAR_P1_L_Addr);
	Press_Config1 = BMP390_Read_Byte(NVM_PAR_P1_H_Addr);
	Press_Config2 = BMP390_Read_Byte(NVM_PAR_P2_L_Addr);
	Press_Config3 = BMP390_Read_Byte(NVM_PAR_P2_H_Addr);
	Press_Config4 = BMP390_Read_Byte(NVM_PAR_P3_Addr);
	Press_Config5 = BMP390_Read_Byte(NVM_PAR_P4_Addr);
	Press_Config6 = BMP390_Read_Byte(NVM_PAR_P5_L_Addr);
	Press_Config7 = BMP390_Read_Byte(NVM_PAR_P5_H_Addr);
	Press_Config8 = BMP390_Read_Byte(NVM_PAR_P6_L_Addr);
	Press_Config9 = BMP390_Read_Byte(NVM_PAR_P6_H_Addr);
	Press_Config10 = BMP390_Read_Byte(NVM_PAR_P7_Addr);
	Press_Config11 = BMP390_Read_Byte(NVM_PAR_P8_Addr);
	Press_Config12 = BMP390_Read_Byte(NVM_PAR_P9_L_Addr);
	Press_Config13 = BMP390_Read_Byte(NVM_PAR_P9_H_Addr);
	Press_Config14 = BMP390_Read_Byte(NVM_PAR_P10_Addr);
	Press_Config15 = BMP390_Read_Byte(NVM_PAR_P11_Addr);
	//Coefficient P1
	Pressure_Para[0] = (Press_Config1<<8)+Press_Config0;//P1
	if(Pressure_Para[0]&0x8000) Pressure_Para[0] = Pressure_Para[0] - Total_Number_16;//P1
	//Coefficient P2
	Pressure_Para[1] = (Press_Config3<<8)+Press_Config2;//P2
	if(Pressure_Para[1]&0x8000) Pressure_Para[1] = Pressure_Para[1] - Total_Number_16;//P2
	//Coefficient P3
	Pressure_Para[2] = Press_Config4;//P3
	if(Pressure_Para[2]&0x80) Pressure_Para[2] = Pressure_Para[2] - Total_Number_8;//P3
	//Coefficient P4
	Pressure_Para[3] = Press_Config5;//P4
	if(Pressure_Para[3]&0x80) Pressure_Para[3] = Pressure_Para[3] - Total_Number_8;//P4
	//Coefficient P5
	Pressure_Para[4] = (Press_Config7<<8)+Press_Config6;//P5
	//Coefficient P6
	Pressure_Para[5] = (Press_Config9<<8)+Press_Config8;//P6
	//Coefficient P7
	Pressure_Para[6] = Press_Config10;//P7
	if(Pressure_Para[6]&0x80) Pressure_Para[6] = Pressure_Para[6] - Total_Number_8;//P7
	//Coefficient P8
	Pressure_Para[7] = Press_Config11;//P8
	if(Pressure_Para[7]&0x80) Pressure_Para[7] = Pressure_Para[7] - Total_Number_8;//P8
	//Coefficient P9
	Pressure_Para[8] = (Press_Config13<<8)+Press_Config12;//P9
	if(Pressure_Para[8]&0x8000) Pressure_Para[8] = Pressure_Para[8] - Total_Number_16;//P9
	//Coefficient P10
	Pressure_Para[9] = Press_Config14;//P10
	if(Pressure_Para[9]&0x80) Pressure_Para[9] = Pressure_Para[9] - Total_Number_8;//P10
	//Coefficient P11
	Pressure_Para[10] = Press_Config15;//P11
	if(Pressure_Para[10]&0x80) Pressure_Para[10] = Pressure_Para[10] - Total_Number_8;//P11
}
	  double PAR_P1,PAR_P2,PAR_P3,PAR_P4,PAR_P5;
	  double PAR_P6,PAR_P7,PAR_P8,PAR_P9,PAR_P10,PAR_P11;
	  double Corr_Pressure,partial_data1,partial_data2,partial_data3,partial_data4;
	  double partial_out1,partial_out2;
double Correcting_Pressure(u32 Pressure,int *Pressure_Para,double Corr_Temperature)
{

	  PAR_P1 = (Pressure_Para[0]-Total_Number_14)/Total_Number_20;
	  PAR_P2 = (Pressure_Para[1]-Total_Number_14)/Total_Number_29;
	  PAR_P3 = Pressure_Para[2]/Total_Number_32;
	  PAR_P4 = Pressure_Para[3]/Total_Number_32/Total_Number_5;
	  PAR_P5 = Pressure_Para[4]/Total_Number_Neg_3;
	  PAR_P6 = Pressure_Para[5]/Total_Number_6;
	  PAR_P7 = Pressure_Para[6]/Total_Number_8;
	  PAR_P8 = Pressure_Para[7]/Total_Number_15;
	  PAR_P9 =  Pressure_Para[8]/Total_Number_32/Total_Number_16;
	  PAR_P10 =  Pressure_Para[9]/Total_Number_32/Total_Number_16;
	  PAR_P11 =  Pressure_Para[10]/Total_Number_32/Total_Number_32/Total_Number_1;
	  //Calculation
	  partial_data1 = PAR_P6*Corr_Temperature;
	  partial_data2 = PAR_P7*Corr_Temperature*Corr_Temperature;
	  partial_data3 = PAR_P8*Corr_Temperature*Corr_Temperature*Corr_Temperature;
	  partial_out1 = PAR_P5+partial_data1+partial_data2+partial_data3;
	
	  partial_data1 = PAR_P2*Corr_Temperature;
	  partial_data2 = PAR_P3*Corr_Temperature*Corr_Temperature;
	  partial_data3 = PAR_P4*Corr_Temperature*Corr_Temperature*Corr_Temperature;
	  partial_out2 = (double)(Pressure)*(PAR_P1+partial_data1+partial_data2+partial_data3);
		
	  partial_data1 = (double)(Pressure)*(double)(Pressure);
	  partial_data2 = PAR_P9+PAR_P10*Corr_Temperature;
	  partial_data3 = partial_data1*partial_data2;
	  partial_data4 = partial_data3+(double)(Pressure)*(double)(Pressure)*(double)(Pressure)*PAR_P11;
	  Corr_Pressure = partial_out1+partial_out2+partial_data4;
		return Corr_Pressure;
}
 	double Corr_Temperature,PAR_T1,PAR_T2,PAR_T3;
	double	partial_data1,parital_data2;
    double   nub;
double Correcting_Temperature(u32 Temperature,int *Temperature_Para)
{	
//	double Corr_Temperature,PAR_T1,PAR_T2,PAR_T3;
//	double	partial_data1,parital_data2;
	
	
	PAR_T1 = Temperature_Para[0]/Total_Number_Neg_8;
	PAR_T2 = Temperature_Para[1]/Total_Number_30;
	PAR_T3 = Temperature_Para[2]/Total_Number_32/Total_Number_16;
	//Calculation
	partial_data1 = (double)(Temperature)-PAR_T1;
	parital_data2 = partial_data1*PAR_T2;
    nub=PAR_T2*PAR_T1;
	Corr_Temperature = parital_data2+partial_data1*partial_data1*PAR_T3;
	return Corr_Temperature;
}
float Altitude;
double Correcting_Temp,Correcting_Press;
int Pressure_Para[11],Temperature_Para[3];
void  GetPressAndHeight()
{
float Pressure,Pressure_Temp,Pres_temp;
float Temperature,Temperature_Temp,Temp_temp;
    	Pressure = 0;
		Temperature = 0;
        Pressure = Pressure_Read();
	    Temperature = Temperature_Read();
    
        Correcting_Temp = Correcting_Temperature(Temperature,Temperature_Para);	
		Correcting_Press = Correcting_Pressure(Pressure,Pressure_Para,Correcting_Temp)+Offest_Pressure;	
		Altitude = 44330*(1-pow(Correcting_Press/101325.0,1.0/5.255));	
      //  Correcting_Press =  Correcting_Press/100;
        if(Correcting_Press==0)
        Altitude = 0;
          
}