diff --git a/src/main.c b/src/main.c
index f0fe543..c3cea5d 100644
--- a/src/main.c
+++ b/src/main.c
@@ -2,8 +2,10 @@
 #include "task.h"
 #include "avr/io.h"
 #include "zh_avr_160x_i2c.h"
+#include "zh_avr_encoder.h"
+#include "zh_avr_ac_dimmer.h"
 
-// #define DEBUG
+#define DEBUG
 
 #define BUTTON_I2C_ADDRESS 0x00
 #define LED1_I2C_ADDRESS 0x00
@@ -11,6 +13,9 @@
 #define RELAY_I2C_ADDRESS 0x00
 #define LCD_I2C_ADDRESS 0x00
 
+#define POWER_ENCODER 1
+#define COMPONENT_ENCODER 2
+
 #ifdef DEBUG
 #define BAUD_RATE 9600
 #define BAUD_PRESCALE (F_CPU / 16 / BAUD_RATE - 1)
@@ -38,8 +43,31 @@ zh_avr_pcf8574_handle_t led2_handle = {0};
 zh_avr_pcf8574_handle_t relay_handle = {0};
 zh_avr_pcf8574_handle_t lcd_handle = {0};
 
+zh_avr_encoder_handle_t power_encoder_handle = {0};
+// zh_avr_encoder_handle_t component_encoder_handle = {0};
+
 int main(void)
 {
+    //** Encoders init **/
+    zh_avr_encoder_init_config_t encoder_init_config = ZH_AVR_ENCODER_INIT_CONFIG_DEFAULT();
+    encoder_init_config.a_gpio_number = PORTD5;
+    encoder_init_config.b_gpio_number = PORTD6;
+    encoder_init_config.pullup = true;
+    encoder_init_config.encoder_min_value = 0;
+    encoder_init_config.encoder_max_value = 100;
+    encoder_init_config.encoder_step = 1;
+    encoder_init_config.encoder_number = POWER_ENCODER;
+    zh_avr_encoder_init(&encoder_init_config, &power_encoder_handle);
+    zh_avr_encoder_set(&power_encoder_handle, 50);
+    //** AC dimmer init **/
+    zh_avr_ac_dimmer_init_config_t ac_dimmer_init_config = ZH_AVR_AC_DIMMER_INIT_CONFIG_DEFAULT();
+    ac_dimmer_init_config.ac_dimmer_frequency = ZH_50HZ;
+    ac_dimmer_init_config.zero_cross_port = AVR_PORTD;
+    ac_dimmer_init_config.zero_cross_gpio = PORTD2;
+    ac_dimmer_init_config.triac_port = AVR_PORTD;
+    ac_dimmer_init_config.triac_gpio = PORTD3;
+    zh_avr_ac_dimmer_init(&ac_dimmer_init_config);
+    zh_avr_ac_dimmer_start();
 #ifdef DEBUG
     UBRR0H = (BAUD_PRESCALE >> 8);
     UBRR0L = BAUD_PRESCALE;
@@ -114,8 +142,15 @@ void zh_avr_pcf8574_event_handler(zh_avr_pcf8574_event_on_isr_t *event)
     printf("Interrupt Task Remaining Stack Size %d.\n", uxTaskGetStackHighWaterMark(NULL));
 }
 
+void zh_avr_encoder_event_handler(zh_avr_encoder_event_on_isr_t *event) // Do not delete!
+{
+    printf("Encoder number %d position %0.2f.\n", event->encoder_number, event->encoder_position);
+    printf("Interrupt Task Remaining Stack Size %d.\n", uxTaskGetStackHighWaterMark(NULL));
+}
+
 ISR(PCINT2_vect)
 {
+    zh_avr_encoder_isr_handler(&power_encoder_handle);
     if (zh_avr_pcf8574_isr_handler() == pdTRUE)
     {
         portYIELD();