diff --git a/main/MXL90614_SMBus_Driver_updated.c b/main/MXL90614_SMBus_Driver_updated.c
new file mode 100644
index 0000000..bdde80f
--- /dev/null
+++ b/main/MXL90614_SMBus_Driver_updated.c
@@ -0,0 +1,374 @@
+#include "driver/i2c.h"
+#include "esp_log.h"
+#include "include/MLX90614_SMBus_Driver.h"
+
+#define I2C_MASTER_TX_BUF_DISABLE 0 /*!< I2C master doesn't need buffer */
+#define I2C_MASTER_RX_BUF_DISABLE 0 /*!< I2C master doesn't need buffer */
+#define WRITE_BIT I2C_MASTER_WRITE  /*!< I2C master write */
+#define READ_BIT I2C_MASTER_READ    /*!< I2C master read */
+#define ACK_CHECK_EN 0x1            /*!< I2C master will check ack from slave*/
+#define ACK_CHECK_DIS 0x0           /*!< I2C master will not check ack from slave */
+#define ACK_VAL 0x0                 /*!< I2C ack value */
+#define NACK_VAL 0x1                /*!< I2C nack value */
+
+
+#define MLX90614_DEFAULT_ADDRESS 0x5A
+#define EEPROM_UNLOCK_ADDR 0x0F
+#define EEPROM_EMISSIVITY_ADDR 0x04
+
+uint8_t sda;
+uint8_t scl;
+static const char *TAG = "MLX90614_Module";
+uint8_t Calculate_PEC(uint8_t, uint8_t);
+
+void WaitEE(uint16_t ms);
+
+void MLX90614_SMBusInit(uint8_t sda_gpio, uint8_t scl_gpio, int freq){   
+    sda = sda_gpio;
+    scl = scl_gpio;
+    i2c_config_t MLX90614_config = {
+        .mode = I2C_MODE_MASTER,       /*!< I2C mode */
+        .sda_io_num = sda_gpio,        /*!< GPIO number for I2C sda signal */
+        .sda_pullup_en = GPIO_PULLUP_ENABLE,  /*!< Internal GPIO pull mode for I2C sda signal*/
+        .scl_io_num = scl_gpio,       /*!< GPIO number for I2C scl signal */
+        .scl_pullup_en = GPIO_PULLUP_ENABLE,  /*!< Internal GPIO pull mode for I2C scl signal*/
+        .master.clk_speed = freq    /*!< I2C clock frequency for master mode, (no higher than 1MHz for now) */
+    };
+    i2c_param_config(I2C_NUM_0, &MLX90614_config);
+    i2c_driver_install(I2C_NUM_0, I2C_MODE_MASTER, I2C_MASTER_RX_BUF_DISABLE, I2C_MASTER_TX_BUF_DISABLE, 0);
+}
+// Function to read data from MLX90614 over I2C
+int MLX90614_SMBusRead(uint8_t slaveAddr, uint8_t reg_addr, uint16_t *data) {
+    //printf("running MLX90614_SMBusRead\n");
+    vTaskDelay(50 / portTICK_PERIOD_MS);//50ms delay
+    uint8_t chip_addr;
+    uint8_t data_addr;
+    uint8_t pec;
+    uint16_t *p;
+    esp_err_t ret;
+
+    p = data;
+    chip_addr = (slaveAddr << 1);
+    data_addr = reg_addr;
+    pec = chip_addr;
+    uint8_t received_data[3] = {0, 0, 0};
+
+    for (int attempts = 0; attempts < 3; attempts++) {  // Retry mechanism
+        i2c_cmd_handle_t cmd = i2c_cmd_link_create();
+        i2c_master_start(cmd);
+        i2c_master_write_byte(cmd, chip_addr | WRITE_BIT, ACK_CHECK_EN);
+        i2c_master_write_byte(cmd, data_addr, ACK_CHECK_EN);
+        i2c_master_start(cmd);
+        chip_addr = chip_addr | 0x01;
+        i2c_master_write_byte(cmd, chip_addr | READ_BIT, ACK_CHECK_EN);
+        i2c_master_read(cmd, received_data, 2, ACK_VAL);
+        i2c_master_read_byte(cmd, received_data + 2, NACK_VAL);
+        i2c_master_stop(cmd);
+        ret = i2c_master_cmd_begin(I2C_NUM_0, cmd, 1000 / portTICK_PERIOD_MS);
+        i2c_cmd_link_delete(cmd);
+
+        if (ret == ESP_OK) {
+            pec = Calculate_PEC(0, pec);
+            pec = Calculate_PEC(pec, data_addr);
+            pec = Calculate_PEC(pec, chip_addr);
+            pec = Calculate_PEC(pec, received_data[0]);
+            pec = Calculate_PEC(pec, received_data[1]);
+
+            //ESP_LOGI(TAG, "Received data: chip_Addr: %02X, data_received: %02X %02X, PEC: %02X", chip_addr, received_data[0], received_data[1], pec);
+            vTaskDelay(10 / portTICK_PERIOD_MS);//10ms delay
+            if (pec == received_data[2]) {
+                *p = (uint16_t)received_data[1] * 256 + (uint16_t)received_data[0];
+                return 0;  // Success
+            } else {
+                ESP_LOGE(TAG, "PEC mismatch: expected %02X, received %02X", pec, received_data[2]);
+                return -2;  // PEC mismatch error
+            }
+        } else if (ret == ESP_ERR_TIMEOUT) {
+            ESP_LOGW(TAG, "Bus is busy, retrying... (%d/3)", attempts + 1);
+        } else {
+            ESP_LOGE(TAG, "Read failed, retrying... (%d/3)", attempts + 1);
+        }
+    }
+
+    return -1;  // Failed after retries
+}
+
+int MLX90614_SMBusWrite(uint8_t slaveAddr, uint8_t writeAddress, uint16_t data) {
+    printf("running MLX90614_SMBusWrite\n");
+    uint8_t chip_addr;
+    uint8_t send_data[4] = {0, 0, 0, 0};
+    static uint16_t dataCheck;
+    uint8_t pec;
+    esp_err_t ret;
+
+    chip_addr = (slaveAddr << 1);
+    send_data[0] = writeAddress;
+    send_data[1] = data & 0x00FF;
+    send_data[2] = data >> 8;
+
+    pec = Calculate_PEC(0, chip_addr);
+    pec = Calculate_PEC(pec, send_data[0]);
+    pec = Calculate_PEC(pec, send_data[1]);
+    pec = Calculate_PEC(pec, send_data[2]);
+
+    send_data[3] = pec;
+
+    //ESP_LOGI(TAG, "Sending data: Addr: %02X, Write Addr: %02X, Data: %02X %02X, PEC: %02X", chip_addr, send_data[0], send_data[1], send_data[2], send_data[3]);
+    vTaskDelay(10 / portTICK_PERIOD_MS);//10ms delay
+    for (int attempts = 0; attempts < 3; attempts++) {  // Retry mechanism
+        i2c_cmd_handle_t cmd = i2c_cmd_link_create();
+        i2c_master_start(cmd);
+        i2c_master_write_byte(cmd, chip_addr | WRITE_BIT, ACK_CHECK_EN);
+        for (int i = 0; i < 4; i++) {
+            i2c_master_write_byte(cmd, send_data[i], ACK_CHECK_EN);
+        }
+        i2c_master_stop(cmd);
+        ret = i2c_master_cmd_begin(I2C_NUM_0, cmd, 1000 / portTICK_PERIOD_MS);
+        i2c_cmd_link_delete(cmd);
+
+        if (ret == ESP_OK) {
+            ESP_LOGI(TAG, "Write OK");
+            MLX90614_SMBusRead(slaveAddr, writeAddress, &dataCheck);
+            if (dataCheck == data) {
+                return 0;  // Success
+            } else {
+                ESP_LOGE(TAG, "Data verification failed: expected %04X, received %04X", data, dataCheck);
+                return -3;  // Data verification failed
+            }
+        } else if (ret == ESP_ERR_TIMEOUT) {
+            ESP_LOGW(TAG, "Bus is busy, retrying... (%d/3)", attempts + 1);
+        } else {
+            ESP_LOGE(TAG, "Write failed, retrying... (%d/3)", attempts + 1);
+        }
+    }
+
+    return -1;  // Failed after retries
+}
+int MLX90614_SendCommand(uint8_t slaveAddr, uint8_t command) {
+    uint8_t chip_addr;
+    uint8_t send_data[2] = {0, 0};
+    uint8_t pec;
+    esp_err_t ret;
+
+    if (command != 0x60 && command != 0x61) {
+        return -5;  // Invalid command
+    }
+
+    chip_addr = (slaveAddr << 1);
+    send_data[0] = command;
+
+    pec = Calculate_PEC(0, chip_addr);
+    pec = Calculate_PEC(pec, send_data[0]);
+
+    send_data[1] = pec;
+
+    for (int attempts = 0; attempts < 3; attempts++) {  // Retry mechanism
+        i2c_cmd_handle_t cmd = i2c_cmd_link_create();
+        i2c_master_start(cmd);
+        i2c_master_write_byte(cmd, chip_addr | WRITE_BIT, ACK_CHECK_EN);
+        for (int i = 0; i < 2; i++) {
+            i2c_master_write_byte(cmd, send_data[i], ACK_CHECK_EN);
+        }
+        i2c_master_stop(cmd);
+        ret = i2c_master_cmd_begin(I2C_NUM_0, cmd, 1000 / portTICK_PERIOD_MS);
+        i2c_cmd_link_delete(cmd);
+
+        if (ret == ESP_OK) {
+            ESP_LOGI(TAG, "Command sent successfully");
+            return 0;  // Success
+        } else if (ret == ESP_ERR_TIMEOUT) {
+            ESP_LOGW(TAG, "Bus is busy, retrying... (%d/3)", attempts + 1);
+        } else {
+            ESP_LOGE(TAG, "Command failed, retrying... (%d/3)", attempts + 1);
+        }
+    }
+
+    return -1;  // Failed after retries
+}
+
+
+uint8_t Calculate_PEC(uint8_t initPEC, uint8_t newData) {
+    uint8_t data;
+    uint8_t bitCheck;
+
+    data = initPEC ^ newData;
+
+    for (int i = 0; i < 8; i++) {
+        bitCheck = data & 0x80;
+        data = data << 1;
+
+        if (bitCheck != 0) {
+            data = data ^ 0x07;
+        }
+    }
+    return data;
+}
+
+/*
+int MLX90614_SMBusRead(uint8_t slaveAddr, uint8_t reg_addr, uint16_t *data){
+    printf("running MLX90614_SMBusRead\n");
+    uint8_t chip_addr; 
+    uint8_t data_addr;                          
+    uint8_t pec;                               
+    uint16_t *p;
+
+    p = data;
+    chip_addr = (slaveAddr << 1);
+    data_addr = reg_addr;
+    pec = chip_addr;
+    uint8_t recived_data[3] = {0,0,0};
+
+    i2c_cmd_handle_t cmd = i2c_cmd_link_create();
+    i2c_master_start(cmd);
+    i2c_master_write_byte(cmd, chip_addr | WRITE_BIT, ACK_CHECK_EN);
+    i2c_master_write_byte(cmd, data_addr, ACK_CHECK_EN);
+    i2c_master_start(cmd);
+    chip_addr = chip_addr | 0x01;
+    i2c_master_write_byte(cmd, chip_addr | READ_BIT, ACK_CHECK_EN);
+    i2c_master_read(cmd, recived_data, 2, ACK_VAL);
+    i2c_master_read_byte(cmd, recived_data + 2, NACK_VAL);       
+    i2c_master_stop(cmd);  
+    esp_err_t ret = i2c_master_cmd_begin(I2C_NUM_0, cmd, 1000 / portTICK_PERIOD_MS);
+    i2c_cmd_link_delete(cmd);
+    if (ret == ESP_OK) {
+        pec = Calculate_PEC(0, pec);
+        pec = Calculate_PEC(pec, data_addr);
+        pec = Calculate_PEC(pec, chip_addr);
+        pec = Calculate_PEC(pec, recived_data[0]);
+        pec = Calculate_PEC(pec, recived_data[1]);
+    
+    ESP_LOGI(TAG, "Received data: chip_Addr: %02X, data_recovid: %02X %02X, PEC: %02X", chip_addr, recived_data[0], recived_data[1],pec);
+
+    } else if (ret == ESP_ERR_TIMEOUT) {
+        ESP_LOGW(TAG, "Bus is busy");
+    } else {
+        ESP_LOGW(TAG, "Read failed");
+    }
+    if (pec != recived_data[2])
+    {
+        return -2;
+    }
+        
+    *p = (uint16_t)recived_data[1]*256 + (uint16_t)recived_data[0];
+    return 0;   
+}
+
+int MLX90614_SMBusWrite(uint8_t slaveAddr, uint8_t writeAddress, uint16_t data)
+{
+    printf("running MLX90614_SMBusWrite\n");
+    uint8_t chip_addr;
+    uint8_t send_data[4] = {0,0,0,0};
+    static uint16_t dataCheck;
+    uint8_t pec;
+    
+    chip_addr = (slaveAddr << 1);
+    send_data[0] = writeAddress;
+    send_data[1] = data & 0x00FF;
+    send_data[2] = data >> 8;
+    
+    pec = Calculate_PEC(0, chip_addr);
+    pec = Calculate_PEC(pec, send_data[0]);
+    pec = Calculate_PEC(pec, send_data[1]);
+    pec = Calculate_PEC(pec, send_data[2]);
+    
+    send_data[3] = pec;
+
+    ESP_LOGI(TAG, "Sending data: Addr: %02X, Write Addr: %02X, Data: %02X %02X, PEC: %02X", chip_addr, send_data[0], send_data[1], send_data[2], send_data[3]);
+
+    // Send the unlock command to the EEPROM at address 0x0F
+    int test = MLX90614_SendCommand(MLX90614_DEFAULT_ADDRESS, 0x60);
+        if (test == 0) {
+            ESP_LOGI("MLX90614", "EEPROM unlocked successfully");
+        } else {
+            ESP_LOGE("MLX90614", "Failed to unlock EEPROM");
+        }
+    ESP_LOGI(TAG, "Sending data: Addr: %02X, Write Addr: %02X, Data: %02X %02X, PEC: %02X", chip_addr, send_data[0], send_data[1], send_data[2], send_data[3]);
+
+    i2c_cmd_handle_t cmd = i2c_cmd_link_create();
+    i2c_master_start(cmd);
+    i2c_master_write_byte(cmd, chip_addr | WRITE_BIT, ACK_CHECK_EN);
+    for (int i = 0; i < 3; i++) {
+        i2c_master_write_byte(cmd, send_data[i], ACK_CHECK_EN);
+    }
+    i2c_master_stop(cmd);
+    esp_err_t ret = i2c_master_cmd_begin(I2C_NUM_0, cmd, 1000 / portTICK_PERIOD_MS);
+    i2c_cmd_link_delete(cmd);
+    if (ret == ESP_OK) {
+        ESP_LOGI(TAG, "Write OK");
+    } else if (ret == ESP_ERR_TIMEOUT) {
+        ESP_LOGW(TAG, "Bus is busy");
+    } else {
+        ESP_LOGW(TAG, "Write Failed");
+    }       
+    
+    MLX90614_SMBusRead(slaveAddr, writeAddress, &dataCheck);
+    
+    if ( dataCheck != data)
+    {
+        return -3;
+    }    
+    
+    return 0;
+}
+
+int MLX90614_SendCommand(uint8_t slaveAddr, uint8_t command)
+{
+    uint8_t chip_addr;
+    int ack = 0;
+    uint8_t send_data[2]= {0,0};
+    uint8_t pec;
+    
+    if(command != 0x60 && command != 0x61)
+    {
+        return -5;
+    }
+         
+    chip_addr = (slaveAddr << 1);
+    send_data[0] = command;
+        
+    pec = Calculate_PEC(0, chip_addr);
+    pec = Calculate_PEC(pec, send_data[0]);
+       
+    send_data[1] = pec;
+    
+    i2c_cmd_handle_t cmd = i2c_cmd_link_create();
+    i2c_master_start(cmd);
+    i2c_master_write_byte(cmd, chip_addr | WRITE_BIT, ACK_CHECK_EN);
+    for (int i = 0; i < 2; i++) {
+        i2c_master_write_byte(cmd, send_data[i], ACK_CHECK_EN);
+    }
+    i2c_master_stop(cmd);
+    esp_err_t ret = i2c_master_cmd_begin(I2C_NUM_0, cmd, 1000 / portTICK_PERIOD_MS);
+    i2c_cmd_link_delete(cmd);
+    if (ret == ESP_OK) {
+        ESP_LOGI(TAG, "Write OK");
+    } else if (ret == ESP_ERR_TIMEOUT) {
+        ESP_LOGW(TAG, "Bus is busy");
+    } else {
+        ESP_LOGW(TAG, "Write Failed");
+    }
+        
+    return 0;
+}    
+
+uint8_t Calculate_PEC (uint8_t initPEC, uint8_t newData)
+{
+    uint8_t data;
+    uint8_t bitCheck;
+
+    data = initPEC ^ newData;
+    
+    for (int i=0; i<8; i++ )
+    {
+        bitCheck = data & 0x80;
+        data = data << 1;
+        
+        if (bitCheck != 0)
+        {
+            data = data ^ 0x07;
+        }
+        
+    }
+    return data;
+}
+*/