#include <Wire.h>
#include <LiquidCrystal.h>
#include <OneWire.h>

LiquidCrystal lcd(12, 11, 5, 4, 3, 2);    // Deklaracja wyswietlacza
OneWire  ds(7);                           // Deklaracja termometru

//
// AKCELEROMETR
//
  byte Version[3];
  int8_t x_data;
  int8_t y_data;
  int8_t z_data;
  byte range=0x00;
  float divi=16;
  float x,y,z;
  int8_t x_cal = 0;
  int8_t y_cal = 0;
  int8_t z_cal = 0;

//
// TEMPERATURA (DS18B20)
//
  byte i;
  byte present = 0;
  byte type_s;
  byte data[12];
  byte addr[8];
  float celsius, fahrenheit;
  int HighByte, LowByte, SignBit, Whole, Fract, TReading, Tc_100, FWhole;

//
// ZMIENNE ITERACYJNE
//
  int c = 1;

//
// PRZYPISANIE PINOW
//
  int buttonpin = 8;
  int buttonpin2 = 9;

void setup()
{
  Serial.begin(9600);
  pinMode(buttonpin, INPUT_PULLUP);
  pinMode(buttonpin2, INPUT_PULLUP);

  // AKCELEROMETR
  Wire.begin();
  Wire.beginTransmission(0x0A);
  Wire.write(0x22);
  Wire.write(range);
  Wire.write(0x20);
  Wire.write(0x05);
  Wire.endTransmission();
  AccelerometerCal();


  // WYSWIETLACZ
  lcd.begin(16,2);
  init_wyswietlacz();
}

void init_wyswietlacz(){
  lcd.setCursor(6, 0);
  lcd.print("MOTH");
  delay(2000);
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("IWP Virtual");
  lcd.setCursor(0, 1);
  lcd.print("Engineering");
  delay(2000);
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("System created");
  lcd.setCursor(0, 1);
  lcd.print("by Haras & Enc.");
  delay(2000);
  lcd.clear();
  lcd.setCursor(0,0);
  lcd.print("Soft version:");
  lcd.setCursor(6,1);
  lcd.print(" 0.1a");
  delay(2000);
  lcd.clear();
}

void AccelerometerCal(){
  Wire.beginTransmission(0x0A);
  Wire.write(0x04);
  Wire.endTransmission();
  Wire.requestFrom(0x0A,1);
  while(Wire.available())
  {
    Version[0] = Wire.read();
  }
  x_cal=(int8_t)Version[0]>>2;

  Wire.beginTransmission(0x0A);
  Wire.write(0x06);
  Wire.endTransmission();
  Wire.requestFrom(0x0A,1);
  while(Wire.available())
  {
    Version[1] = Wire.read();
  }
  y_cal=(int8_t)Version[1]>>2;

  Wire.beginTransmission(0x0A);
  Wire.write(0x08);
  Wire.endTransmission();
  Wire.requestFrom(0x0A,1);
  while(Wire.available())
  {
    Version[2] = Wire.read();
  }
  z_cal=(int8_t)Version[2]>>2;
}

void AccelerometerInit()
{
  Wire.beginTransmission(0x0A);
  Wire.write(0x04);
  Wire.endTransmission();
  Wire.requestFrom(0x0A,1);
  while(Wire.available())
  {
    Version[0] = Wire.read();
  }
  x_data=(int8_t)Version[0]>>2;

  Wire.beginTransmission(0x0A);
  Wire.write(0x06);
  Wire.endTransmission();
  Wire.requestFrom(0x0A,1);
  while(Wire.available())
  {
    Version[1] = Wire.read();
  }
  y_data=(int8_t)Version[1]>>2;

  Wire.beginTransmission(0x0A);
  Wire.write(0x08);
  Wire.endTransmission();
  Wire.requestFrom(0x0A,1);
  while(Wire.available())
  {
    Version[2] = Wire.read();
  }
  z_data=(int8_t)Version[2]>>2;

  x=(float)(x_data- x_cal)/divi;
  y=(float)(y_data- y_cal)/divi;
  z=(float)(z_data- z_cal)/divi;
}

void odczyt_temp(){
  if ( !ds.search(addr)) {
    ds.reset_search();
    delay(250);
    return;
  }

  if (OneWire::crc8(addr, 7) != addr[7]) {
    return;
  }
  switch (addr[0]) {
    case 0x10:
      type_s = 1;
    break;
    case 0x28:
      type_s = 0;
    break;
    case 0x22:
      type_s = 0;
    break;
    default:
    return;
  }

  ds.reset();
  ds.select(addr);
  ds.write(0x44, 1);
  present = ds.reset();
  ds.select(addr);
  ds.write(0xBE);


  for ( i = 0; i < 9; i++) {
    data[i] = ds.read();
  }

  int16_t raw = (data[1] << 8) | data[0];
  if (type_s) {
    raw = raw << 3;
    if (data[7] == 0x10) {
      raw = (raw & 0xFFF0) + 12 - data[6];
    }
  }
  else {
    byte cfg = (data[4] & 0x60);
    if (cfg == 0x00) raw = raw & ~7;
    else if (cfg == 0x20) raw = raw & ~3;
    else if (cfg == 0x40) raw = raw & ~1;
  }

  celsius = (float)raw / 16.0;
  fahrenheit = celsius * 1.8 + 32.0;
}

void loop()
{

  switch(range)
  {
  case 0x00:divi=16;  break;
  case 0x01:divi=8;  break;
  case 0x02:divi=4;  break;
  case 0x03:divi=2;  break;
  default: Serial.println("range setting is Wrong,range:from 0to 3.Please check!");while(1);
  }
  AccelerometerInit();


  if (digitalRead(8) == HIGH)
  {
    delay(100);
    c = c+1;
    lcd.clear();
    if (c > 4) {
      c = 1;
    }
  }

  if (digitalRead(9) == HIGH)
  {
    delay(100);
    lcd.clear();
    c=1;

  }

  switch(c){

   case 1:
     lcd.setCursor(0,0);
     lcd.print("X=");
     lcd.print(x);         // print the character
     lcd.setCursor (8,0);

     lcd.print("Y=");
     lcd.print(y);         // print the character

     lcd.setCursor(6,1);
     lcd.print("Z=");           // print the character
     lcd.print(z);
   break;

   case 2:
   odczyt_temp();
     lcd.setCursor(0,0);
     lcd.print("Temperatura: ");
     lcd.setCursor(0,1);
     lcd.print(celsius);
     lcd.print(" C");
   lcd.setCursor(8,1);
   lcd.print(fahrenheit);
   lcd.print(" F");
   break;

   case 3:
     lcd.setCursor(0,0);
     lcd.print("Co robi Jarek ?");
   break;

   case 4:
     lcd.setCursor(0,0);
     lcd.print("Stoper");
   break;

  }

 delay(100);

}