diff --git a/lib/si5351/si5351.c b/lib/si5351/si5351.c
--- a/lib/si5351/si5351.c
+++ b/lib/si5351/si5351.c
@@ -334,7 +334,8 @@ uint8_t si5351_set_freq(uint64_t freq, u
 uint8_t params[20];
 
 void si5351_set_pll(uint64_t pll_freq, enum si5351_pll target_pll)
-{ struct Si5351RegSet pll_reg;
+{
+  struct Si5351RegSet pll_reg;
 
   si5351_pll_calc(pll_freq, &pll_reg, ref_correction);
 
@@ -905,16 +906,10 @@ void si5351_set_clock_fanout(enum si5351
 
 
 
-/* AAAH REFREAKINGIMPLEMENT WITH COMMON STANDARD I2C THINGS:
-~/Projects/featherhab-fw/libopencm3/lib/stm32/common/i2c_common_all.c
-*/
-
 uint8_t si5351_write_bulk(uint8_t addr, uint8_t bytes, uint8_t *data)
 {
-    HAL_Delay(300);
     uint32_t res = HAL_I2C_Mem_Write(si5351_i2cport, SI5351_BUS_BASE_ADDR, addr, 1, data, bytes, 100);
     led_blink(res);
-    HAL_Delay(300);
 
 
 
@@ -931,12 +926,10 @@ uint8_t si5351_write_bulk(uint8_t addr, 
 
 uint8_t si5351_write(uint8_t addr, uint8_t data)
 {
-    HAL_Delay(300);
     uint8_t data_arr[1] = {data};
-    uint8_t res = HAL_I2C_Mem_Write(si5351_i2cport, SI5351_BUS_BASE_ADDR, addr, 1, data, 1, 100);
+    volatile uint8_t res = HAL_I2C_Mem_Write(si5351_i2cport, SI5351_BUS_BASE_ADDR, addr, 1, data_arr, 1, 100);
 
     led_blink(res);
-    HAL_Delay(300);
 /*
 	Wire.beginTransmission(SI5351_BUS_BASE_ADDR);
 	Wire.write(addr);
@@ -949,11 +942,9 @@ uint8_t si5351_read(uint8_t addr)
 {
 	uint8_t data_arr[1] = {0};
 
-    HAL_Delay(300);
     uint8_t res = HAL_I2C_Mem_Read(si5351_i2cport, SI5351_BUS_BASE_ADDR, addr, 1, data_arr, 1, 100);
 
     led_blink(res);
-    HAL_Delay(300);
 /*
 	Wire.beginTransmission(SI5351_BUS_BASE_ADDR);
 	Wire.write(addr);
@@ -966,7 +957,7 @@ uint8_t si5351_read(uint8_t addr)
 		reg_val = Wire.read();
 	}
 */	
-	return data_arr[1];
+	return data_arr[0];
 }
 
 /*********************/