diff --git a/storno_cqp6xx_digital_xtal/Debug/Makefile b/storno_cqp6xx_digital_xtal/Debug/Makefile
index 61fb183..20f64e1 100644
--- a/storno_cqp6xx_digital_xtal/Debug/Makefile
+++ b/storno_cqp6xx_digital_xtal/Debug/Makefile
@@ -122,63 +122,63 @@ LINKER_SCRIPT_DEP+=
 avr_eeprom_driver/avr_eeprom_driver.o: ../avr_eeprom_driver/avr_eeprom_driver.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
 avr_gpio_driver/avr_gpio.o: ../avr_gpio_driver/avr_gpio.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
 avr_i2c_driver/avr_i2c.o: ../avr_i2c_driver/avr_i2c.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
 avr_uart_driver/avr_uart.o: ../avr_uart_driver/avr_uart.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
 cm_msg/cm_msg.o: ../cm_msg/cm_msg.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
 cm_task_manager/cm_task_manager.o: ../cm_task_manager/cm_task_manager.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
 ./cqm6xx_app.o: .././cqm6xx_app.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
 ./main.o: .././main.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
 si5351_driver/si5351_driver.o: ../si5351_driver/si5351_driver.c
 	@echo Building file: $<
 	@echo Invoking: AVR/GNU C Compiler : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include"  -O1 -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -g2 -Wall -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
 	@echo Finished building: $<
 	
 
@@ -208,13 +208,13 @@ all: $(OUTPUT_FILE_PATH) $(ADDITIONAL_DEPENDENCIES)
 $(OUTPUT_FILE_PATH): $(OBJS) $(USER_OBJS) $(OUTPUT_FILE_DEP) $(LIB_DEP) $(LINKER_SCRIPT_DEP)
 	@echo Building target: $@
 	@echo Invoking: AVR/GNU Linker : 5.4.0
-	$(QUOTE)E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE) -o$(OUTPUT_FILE_PATH_AS_ARGS) $(OBJS_AS_ARGS) $(USER_OBJS) $(LIBS) -Wl,-Map="storno_cqp6xx_digital_xtal.map" -Wl,--start-group -Wl,-lm  -Wl,--end-group -Wl,-L"D:\cm_projects\microchip_studio_projects\storno_cqp6xx_digital_xtal\storno_cqp6xx_digital_xtal\si5351_driver\include" -Wl,-L"../avr_uart_driver"  -Wl,--gc-sections -mmcu=attiny402 -B "E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402"  
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE) -o$(OUTPUT_FILE_PATH_AS_ARGS) $(OBJS_AS_ARGS) $(USER_OBJS) $(LIBS) -Wl,-Map="storno_cqp6xx_digital_xtal.map" -Wl,--start-group -Wl,-lm  -Wl,--end-group -Wl,-L"D:\cm_projects\microchip_studio_projects\storno_cqp6xx_digital_xtal\storno_cqp6xx_digital_xtal\si5351_driver\include" -Wl,-L"../avr_uart_driver"  -Wl,--gc-sections -mmcu=attiny402 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402"  
 	@echo Finished building target: $@
-	"E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -O ihex -R .eeprom -R .fuse -R .lock -R .signature -R .user_signatures  "storno_cqp6xx_digital_xtal.elf" "storno_cqp6xx_digital_xtal.hex"
-	"E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -j .eeprom  --set-section-flags=.eeprom=alloc,load --change-section-lma .eeprom=0  --no-change-warnings -O ihex "storno_cqp6xx_digital_xtal.elf" "storno_cqp6xx_digital_xtal.eep" || exit 0
-	"E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objdump.exe" -h -S "storno_cqp6xx_digital_xtal.elf" > "storno_cqp6xx_digital_xtal.lss"
-	"E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -O srec -R .eeprom -R .fuse -R .lock -R .signature -R .user_signatures "storno_cqp6xx_digital_xtal.elf" "storno_cqp6xx_digital_xtal.srec"
-	"E:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-size.exe" "storno_cqp6xx_digital_xtal.elf"
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -O ihex -R .eeprom -R .fuse -R .lock -R .signature -R .user_signatures  "storno_cqp6xx_digital_xtal.elf" "storno_cqp6xx_digital_xtal.hex"
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -j .eeprom  --set-section-flags=.eeprom=alloc,load --change-section-lma .eeprom=0  --no-change-warnings -O ihex "storno_cqp6xx_digital_xtal.elf" "storno_cqp6xx_digital_xtal.eep" || exit 0
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objdump.exe" -h -S "storno_cqp6xx_digital_xtal.elf" > "storno_cqp6xx_digital_xtal.lss"
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -O srec -R .eeprom -R .fuse -R .lock -R .signature -R .user_signatures "storno_cqp6xx_digital_xtal.elf" "storno_cqp6xx_digital_xtal.srec"
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-size.exe" "storno_cqp6xx_digital_xtal.elf"
 	
 	
 
diff --git a/storno_cqp6xx_digital_xtal/Debug/avr_eeprom_driver/avr_eeprom_driver.d b/storno_cqp6xx_digital_xtal/Debug/avr_eeprom_driver/avr_eeprom_driver.d
index 37dd5bc..159c1cd 100644
--- a/storno_cqp6xx_digital_xtal/Debug/avr_eeprom_driver/avr_eeprom_driver.d
+++ b/storno_cqp6xx_digital_xtal/Debug/avr_eeprom_driver/avr_eeprom_driver.d
@@ -2,53 +2,53 @@ avr_eeprom_driver/avr_eeprom_driver.d \
  avr_eeprom_driver/avr_eeprom_driver.o: \
  ../avr_eeprom_driver/avr_eeprom_driver.c \
  ../avr_eeprom_driver/avr_eeprom_driver.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
- E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\eeprom.h
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
+ C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\eeprom.h
 
 ../avr_eeprom_driver/avr_eeprom_driver.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
 
-E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
+C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\eeprom.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\eeprom.h:
diff --git a/storno_cqp6xx_digital_xtal/Debug/avr_eeprom_driver/avr_eeprom_driver.o b/storno_cqp6xx_digital_xtal/Debug/avr_eeprom_driver/avr_eeprom_driver.o
index 330ff44..71a8b72 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/avr_eeprom_driver/avr_eeprom_driver.o and b/storno_cqp6xx_digital_xtal/Debug/avr_eeprom_driver/avr_eeprom_driver.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/avr_gpio_driver/avr_gpio.d b/storno_cqp6xx_digital_xtal/Debug/avr_gpio_driver/avr_gpio.d
index 1f47d49..71cb435 100644
--- a/storno_cqp6xx_digital_xtal/Debug/avr_gpio_driver/avr_gpio.d
+++ b/storno_cqp6xx_digital_xtal/Debug/avr_gpio_driver/avr_gpio.d
@@ -1,49 +1,49 @@
 avr_gpio_driver/avr_gpio.d avr_gpio_driver/avr_gpio.o: \
  ../avr_gpio_driver/avr_gpio.c ../avr_gpio_driver/avr_gpio.h \
  ../avr_gpio_driver/../avr_global_config.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h
 
 ../avr_gpio_driver/avr_gpio.h:
 
 ../avr_gpio_driver/../avr_global_config.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
+C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
diff --git a/storno_cqp6xx_digital_xtal/Debug/avr_gpio_driver/avr_gpio.o b/storno_cqp6xx_digital_xtal/Debug/avr_gpio_driver/avr_gpio.o
index 039c5d8..76a2248 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/avr_gpio_driver/avr_gpio.o and b/storno_cqp6xx_digital_xtal/Debug/avr_gpio_driver/avr_gpio.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/avr_i2c_driver/avr_i2c.d b/storno_cqp6xx_digital_xtal/Debug/avr_i2c_driver/avr_i2c.d
index 7062eba..981b157 100644
--- a/storno_cqp6xx_digital_xtal/Debug/avr_i2c_driver/avr_i2c.d
+++ b/storno_cqp6xx_digital_xtal/Debug/avr_i2c_driver/avr_i2c.d
@@ -1,52 +1,52 @@
 avr_i2c_driver/avr_i2c.d avr_i2c_driver/avr_i2c.o: \
  ../avr_i2c_driver/avr_i2c.c ../avr_i2c_driver/avr_i2c.h \
  ../avr_i2c_driver/../avr_global_config.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
- E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\util\twi.h
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\util\twi.h
 
 ../avr_i2c_driver/avr_i2c.h:
 
 ../avr_i2c_driver/../avr_global_config.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
 
-E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
+C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\util\twi.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\util\twi.h:
diff --git a/storno_cqp6xx_digital_xtal/Debug/avr_i2c_driver/avr_i2c.o b/storno_cqp6xx_digital_xtal/Debug/avr_i2c_driver/avr_i2c.o
index 98525c8..5468745 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/avr_i2c_driver/avr_i2c.o and b/storno_cqp6xx_digital_xtal/Debug/avr_i2c_driver/avr_i2c.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/avr_uart_driver/avr_uart.d b/storno_cqp6xx_digital_xtal/Debug/avr_uart_driver/avr_uart.d
index 2d87c6b..682eab5 100644
--- a/storno_cqp6xx_digital_xtal/Debug/avr_uart_driver/avr_uart.d
+++ b/storno_cqp6xx_digital_xtal/Debug/avr_uart_driver/avr_uart.d
@@ -1,55 +1,55 @@
 avr_uart_driver/avr_uart.d avr_uart_driver/avr_uart.o: \
  ../avr_uart_driver/avr_uart.c ../avr_uart_driver/avr_uart.h \
  ../avr_uart_driver/../avr_global_config.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
- E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\interrupt.h
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
+ C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\interrupt.h
 
 ../avr_uart_driver/avr_uart.h:
 
 ../avr_uart_driver/../avr_global_config.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
 
-E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
+C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\interrupt.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\interrupt.h:
diff --git a/storno_cqp6xx_digital_xtal/Debug/avr_uart_driver/avr_uart.o b/storno_cqp6xx_digital_xtal/Debug/avr_uart_driver/avr_uart.o
index 2e9a100..18cec9f 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/avr_uart_driver/avr_uart.o and b/storno_cqp6xx_digital_xtal/Debug/avr_uart_driver/avr_uart.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/cm_msg/cm_msg.d b/storno_cqp6xx_digital_xtal/Debug/cm_msg/cm_msg.d
index 40dbc25..edd8f5f 100644
--- a/storno_cqp6xx_digital_xtal/Debug/cm_msg/cm_msg.d
+++ b/storno_cqp6xx_digital_xtal/Debug/cm_msg/cm_msg.d
@@ -1,21 +1,21 @@
 cm_msg/cm_msg.d cm_msg/cm_msg.o: ../cm_msg/cm_msg.c ../cm_msg/cm_msg.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h
 
 ../cm_msg/cm_msg.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
diff --git a/storno_cqp6xx_digital_xtal/Debug/cm_msg/cm_msg.o b/storno_cqp6xx_digital_xtal/Debug/cm_msg/cm_msg.o
index 3595b88..292715c 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/cm_msg/cm_msg.o and b/storno_cqp6xx_digital_xtal/Debug/cm_msg/cm_msg.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/cm_task_manager/cm_task_manager.d b/storno_cqp6xx_digital_xtal/Debug/cm_task_manager/cm_task_manager.d
index 2e8172e..b4f75ba 100644
--- a/storno_cqp6xx_digital_xtal/Debug/cm_task_manager/cm_task_manager.d
+++ b/storno_cqp6xx_digital_xtal/Debug/cm_task_manager/cm_task_manager.d
@@ -1,14 +1,14 @@
 cm_task_manager/cm_task_manager.d cm_task_manager/cm_task_manager.o: \
  ../cm_task_manager/cm_task_manager.c \
  ../cm_task_manager/cm_task_manager.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h
 
 ../cm_task_manager/cm_task_manager.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
diff --git a/storno_cqp6xx_digital_xtal/Debug/cm_task_manager/cm_task_manager.o b/storno_cqp6xx_digital_xtal/Debug/cm_task_manager/cm_task_manager.o
index dd6a0c2..75440e0 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/cm_task_manager/cm_task_manager.o and b/storno_cqp6xx_digital_xtal/Debug/cm_task_manager/cm_task_manager.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/cqm6xx_app.d b/storno_cqp6xx_digital_xtal/Debug/cqm6xx_app.d
index ee8027c..33668e5 100644
--- a/storno_cqp6xx_digital_xtal/Debug/cqm6xx_app.d
+++ b/storno_cqp6xx_digital_xtal/Debug/cqm6xx_app.d
@@ -1,42 +1,40 @@
 cqm6xx_app.d cqm6xx_app.o: .././cqm6xx_app.c .././cqm6xx_app.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\string.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
  .././si5351_driver/si5351_driver.h .././avr_gpio_driver/avr_gpio.h \
  .././avr_gpio_driver/../avr_global_config.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
- E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
+ C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h \
  .././avr_uart_driver/avr_uart.h \
  .././avr_uart_driver/../avr_global_config.h .././avr_global_config.h \
- .././avr_eeprom_driver/avr_eeprom_driver.h .././cm_msg/cm_msg.h
+ .././avr_eeprom_driver/avr_eeprom_driver.h .././cm_msg/cm_msg.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\string.h
 
 .././cqm6xx_app.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
-
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\string.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
 
 .././si5351_driver/si5351_driver.h:
 
@@ -44,25 +42,25 @@ e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\includ
 
 .././avr_gpio_driver/../avr_global_config.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
 
-E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
+C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h:
 
 .././avr_uart_driver/avr_uart.h:
 
@@ -73,3 +71,5 @@ e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\av
 .././avr_eeprom_driver/avr_eeprom_driver.h:
 
 .././cm_msg/cm_msg.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\string.h:
diff --git a/storno_cqp6xx_digital_xtal/Debug/cqm6xx_app.o b/storno_cqp6xx_digital_xtal/Debug/cqm6xx_app.o
index f51da2e..6a34529 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/cqm6xx_app.o and b/storno_cqp6xx_digital_xtal/Debug/cqm6xx_app.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/main.d b/storno_cqp6xx_digital_xtal/Debug/main.d
index 42a97ef..fa3e965 100644
--- a/storno_cqp6xx_digital_xtal/Debug/main.d
+++ b/storno_cqp6xx_digital_xtal/Debug/main.d
@@ -1,67 +1,67 @@
 main.d main.o: .././main.c .././avr_global_config.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
  .././avr_uart_driver/avr_uart.h \
  .././avr_uart_driver/../avr_global_config.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
  .././avr_i2c_driver/avr_i2c.h .././avr_i2c_driver/../avr_global_config.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h \
  .././si5351_driver/si5351_driver.h .././cqm6xx_app.h \
  .././avr_eeprom_driver/avr_eeprom_driver.h
 
 .././avr_global_config.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-E:\cm_programs\microchip_studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
+C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\atmel\ATtiny_DFP\1.10.348\include/avr/iotn402.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\xmega.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
 
 .././avr_uart_driver/avr_uart.h:
 
 .././avr_uart_driver/../avr_global_config.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
 
 .././avr_i2c_driver/avr_i2c.h:
 
 .././avr_i2c_driver/../avr_global_config.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdbool.h:
 
 .././si5351_driver/si5351_driver.h:
 
diff --git a/storno_cqp6xx_digital_xtal/Debug/main.o b/storno_cqp6xx_digital_xtal/Debug/main.o
index c372dad..77ecb97 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/main.o and b/storno_cqp6xx_digital_xtal/Debug/main.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/si5351_driver/si5351_driver.d b/storno_cqp6xx_digital_xtal/Debug/si5351_driver/si5351_driver.d
index e9d274b..4d7ec7d 100644
--- a/storno_cqp6xx_digital_xtal/Debug/si5351_driver/si5351_driver.d
+++ b/storno_cqp6xx_digital_xtal/Debug/si5351_driver/si5351_driver.d
@@ -1,31 +1,31 @@
 si5351_driver/si5351_driver.d si5351_driver/si5351_driver.o: \
  ../si5351_driver/si5351_driver.c ../si5351_driver/si5351_driver.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdlib.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\string.h \
- e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\math.h
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdlib.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\string.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\math.h
 
 ../si5351_driver/si5351_driver.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdio.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdarg.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdlib.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdlib.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\string.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\string.h:
 
-e:\cm_programs\microchip_studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\math.h:
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\math.h:
diff --git a/storno_cqp6xx_digital_xtal/Debug/si5351_driver/si5351_driver.o b/storno_cqp6xx_digital_xtal/Debug/si5351_driver/si5351_driver.o
index 71fcf0c..d9e3079 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/si5351_driver/si5351_driver.o and b/storno_cqp6xx_digital_xtal/Debug/si5351_driver/si5351_driver.o differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.elf b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.elf
index 2269b8e..62e2787 100644
Binary files a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.elf and b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.elf differ
diff --git a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.hex b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.hex
index be5797a..3c74601 100644
--- a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.hex
+++ b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.hex
@@ -2,16 +2,16 @@
 :100010002CC02BC02AC029C028C027C026C025C09C
 :1000200024C023C022C021C020C01FC094C11DC055
 :100030001CC01BC011241FBECFEFCDBFDFE3DEBF4E
-:100040002FE3A6E0BFE301C01D92AA38B207E1F793
-:100050001FE3A0E0BFE3E6E6FFE002C005900D92DB
-:10006000A630B107D9F7F0D37CC7CACFEF92FF9281
+:100040002FE3A6E0BFE301C01D92A938B207E1F794
+:100050001FE3A0E0BFE3E4EBFFE002C005900D92D8
+:10006000A630B107D9F717D4A3C7CACFEF92FF9232
 :100070000F931F93CF93DF934423A1F08B01C82FDD
 :10008000D92F4150E42EF12C8FEFE81AF80AE60E32
-:10009000F71EF80161918F01CE014FD721960E1501
+:10009000F71EF80161918F01CE0176D721960E15DA
 :1000A0001F05B9F7DF91CF911F910F91FF90EF904E
 :1000B0000895EF92FF920F931F93CF93DF93442302
 :1000C000A1F0C82FD92F8B014150E42EF12C8FEFD6
-:1000D000E81AF80AE60EF71ECE0127D7F801819339
+:1000D000E81AF80AE60EF71ECE014ED7F801819312
 :1000E0008F012196EE15FF05B9F7DF91CF911F9192
 :1000F0000F91FF90EF90089581110BC0809108043B
 :1001000090E002C0959587956A95E2F781709927EE
@@ -84,166 +84,171 @@
 :100530006BE07FE38091423F9091433F0995109299
 :10054000403F10923F3F80E090E00895009759F0BF
 :100550006115710541F08093423F9093433F609352
-:10056000443F7093453F0895CF93DF93FC01828110
-:1005700093810097E9F03097D9F0218130812317DA
-:10058000B9F0EF01213019F0223051F011C040E0F4
-:1005900060E00ED241E061E08A819B8109D208C00F
-:1005A00041E060E005D240E061E08A819B8100D2B9
-:1005B000DF91CF9108959F92AF92BF92CF92DF9239
-:1005C000EF92FF920F931F93CF93DF93EC01942E42
-:1005D000AD84BE84CF84D888E984FA840B851C85D9
-:1005E0002D813E814F8158858A819B817DD2A98C46
-:1005F000BA8CCB8CDC8CED88FE880F89188D29890C
-:100600003A894B895C89692D8A819B817BD140E045
-:10061000692D8A819B81F3D1DF91CF911F910F9139
-:10062000FF90EF90DF90CF90BF90AF909F90089594
-:10063000FB012081222319F0213051F011C0DC018F
-:1006400014968EE1FB0101900D928A95E1F708C0A6
-:10065000DC0192968EE1FB0101900D928A95E1F703
-:1006600080E090E008950F931F93CF93DF93FC01F8
-:1006700022813381232B09F44DC0009709F44AC02D
-:10068000EC018181813079F118F08230C1F142C0F2
-:1006900010828F010C5F1F4F4EE1B80180E090E0A7
-:1006A00008DD60E08A819B81DED140E060E0CE0120
-:1006B00082DF4EE1B80180E290E0FBDC41E061E0E6
-:1006C000CE0179DF42E061E0CE0175DF40E062E01B
-:1006D0008A819B8194D140E062E08A819B8168D1CC
-:1006E00081E0898317C0CF013FDF8981888363E080
-:1006F00080E002DD019771F482E089830BC0CF01B5
-:1007000033DF8981888363E080E0F6DC892B11F494
-:1007100081E08983DF91CF911F910F9108950F930D
-:100720001F93CF93DF936115710509F488C000977B
-:1007300009F485C0EC01198218826A837B8368E121
-:1007400073E004DF62E572E0CE013CDE8E010E5DF7
-:100750001F4F4EE1B80180E090E0ABDC8AA18150F0
-:100760008E3F08F066C06BC0919191509E3F08F497
-:1007700066C02E173F07C1F783E49DE0A0E0B0E01C
-:100780008D839E83AF83B8878BA39CA3ADA3BEA3A9
-:1007900086EF9CE2A0E0B0E089879A87AB87BC87B0
-:1007A0008FA398A7A9A7BAA78BE598E4A0E1B0E02A
-:1007B0008D879E87AF87B88B8BA79CA7ADA7BEA759
-:1007C00082E190E0A0E0B0E0898B9A8BAB8BBC8B90
-:1007D0008FA798ABA9ABBAAB1D8A1E8A1F8A188E49
-:1007E0001BAA1CAA1DAA1EAA81E090E0A0E0B0E00E
-:1007F000898F9A8FAB8FBC8F8FAB98AFA9AFBAAFF1
-:1008000080E498E7ADE7B1E08E8F9F8FA8A3B9A3EE
-:100810008CAF9DAFAEAFBFAFBE016C5F7F4F4EE1FF
-:1008200080E090E023DC4EE1B80180E290E01EDC45
-:1008300006C0FE01B3969E01205C3F4F95CFDF912D
-:10084000CF911F910F910895CF93DF93CDB7DEB76E
-:10085000A297CDBFDEBF80E090E02BDD40E660E0F8
-:1008600070E0CE0101963FDD41E951E0BE016F5FCE
-:100870007F4FCE01049682D1BE016C5F7F4F86E42C
-:100880009FE34DDF86E49FE3EEDEFCCF8F929F92E5
-:10089000AF92BF92CF92DF92EF92FF920F931F938E
-:1008A000CF93DF93EC01862E5A0168017901C801CC
-:1008B000019611D2982E192FFC018192CF01A60129
-:1008C000B5012AD3A70196012F5F3F4F4F4F5F4FCE
-:1008D000EA81FB8101E0692D712F88819981099559
-:1008E000892D912F90D280E090E0DF91CF911F91E0
-:1008F0000F91FF90EF90DF90CF90BF90AF909F90BF
-:100900008F900895AF92BF92CF92DF92EF92FF92B5
-:100910000F931F93FC01437056895078378B208FBB
-:10092000F28EE38ED601C501072E7CE0B695A79521
-:10093000979587957A95D1F7702D83708295807FF2
-:100940000370802B818FB48AA58A452B468B61303A
-:1009500079F018F06230B9F020C0AF014C5E5F4F03
-:1009600008E010E020E030E06AE2CF018FDF15C040
-:10097000AF014C5E5F4F08E010E020E030E062E342
-:10098000CF0184DF0AC0AF014C5E5F4F08E010E08A
-:1009900020E030E06AE3CF0179DF80E090E01F9152
-:1009A0000F91FF90EF90DF90CF90BF90AF900895A0
-:1009B0000F931F93613051F018F0623069F011C04D
-:1009C000FC01278140FB20F927830BC0FC01278114
-:1009D00040FB21F9278305C0FC01278140FB22F958
-:1009E0002783AC01495F5F4F01E010E020E030E079
-:1009F00063E04CDF80E090E01F910F9108950F932A
-:100A00001F93FC01928540FB97F990799F64928730
-:100A1000613079F018F06230B9F020C0AF01465F64
-:100A20005F4F01E010E020E030E060E1CF012EDF19
-:100A300015C0AF01465F5F4F01E010E020E030E0FD
-:100A400061E1CF0123DF0AC0AF01465F5F4F01E0E4
-:100A500010E020E030E062E1CF0118DF80E090E0BC
-:100A60001F910F9108950F931F93662319F0613022
-:100A700039F00AC0FC0121852B7F277F218704C024
-:100A8000FC01218524602187AC01475F5F4F01E0B5
-:100A900010E020E030E060EFF9DE80E090E01F91B0
-:100AA0000F9108950F931F9331E0611101C030E061
-:100AB000FC01268D30FB25F9268F31E0411101C064
-:100AC00030E0FC01268D30FB27F9268FAC01425E19
-:100AD0005F4F01E010E020E030E061EBD7DE80E026
-:100AE00090E01F910F910895AF92BF92CF92DF9245
-:100AF000EF92FF920F931F93CF93DF93EC0142701D
-:100B00008E858C7F482B4E873F87288BD801C70165
-:100B100088279927AF70BB27FA8AEB8A8A2F8F70B4
-:100B2000898BBC86AD86662319F0613061F015C0F3
-:100B300008E010E020E030E0AE01445F5F4F6AE182
-:100B4000CE01A4DE0AC008E010E020E030E0AE01F3
-:100B5000445F5F4F62E2CE0199DE41E061E0CE0189
-:100B6000A1DF80E090E0DF91CF911F910F91FF9086
-:100B7000EF90DF90CF90BF90AF900895EF92FF92EB
-:100B80000F931F93CF93DF931F92CDB7DEB70097DC
-:100B900009F491C06115710509F490C04115510522
-:100BA00009F48FC07C01DC016D937C931197129640
-:100BB0004D935C931397FC0134968BE1DF011D92FA
-:100BC0008A95E9F78FEF898301E010E020E030E0BB
-:100BD000AE014F5F5F4F63E0C70158DE80E8898355
-:100BE00001E010E020E030E0AE014F5F5F4F60E1D8
-:100BF000C7014CDE01E010E020E030E0AE014F5FC5
-:100C00005F4F61E1C70142DE01E010E020E030E02B
-:100C1000AE014F5F5F4F62E1C70138DE01E010E0D7
-:100C200020E030E0AE014F5F5F4F63E1C7012EDE91
-:100C300001E010E020E030E0AE014F5F5F4F64E183
-:100C4000C70124DE01E010E020E030E0AE014F5F9C
-:100C50005F4F65E1C7011ADE01E010E020E030E0FF
-:100C6000AE014F5F5F4F66E1C70110DE01E010E0AB
-:100C700020E030E0AE014F5F5F4F67E1C70106DE65
-:100C800080EC898301E010E020E030E0AE014F5FAE
-:100C90005F4F67EBC701FADD80E4898301E010E074
-:100CA00020E030E0AE014F5F5F4F6BEBC701EEDD40
-:100CB00080E090E008C08FEF9FEF05C08FEF9FEFBF
-:100CC00002C08FEF9FEF0F90DF91CF911F910F9197
-:100CD000FF90EF9008950F931F93CF93DF9382308F
-:100CE000910510F482E090E0E091883FF091893F17
-:100CF00020E030E0A0E0B0E0309719F14081518170
-:100D00000281138148175907C8F08417950769F4C1
-:100D1000109731F012960C93129713961C9327C0DC
-:100D20000093883F1093893F22C02115310519F0A7
-:100D30004217530718F49A01BD01EF01DF01F801D2
-:100D4000DBCF21153105F9F0281B390B2430310593
-:100D500080F48A819B816115710521F0FB018283FA
-:100D6000938304C08093883F9093893FFE0132961D
-:100D700044C0FE01E20FF31F819391932250310989
-:100D8000288339833AC02091863F3091873F232BB7
-:100D900041F42091023F3091033F2093863F3093EE
-:100DA000873F2091003F3091013F2115310541F4EB
-:100DB0002DB73EB74091043F5091053F241B350BA2
-:100DC000E091863FF091873FE217F307A0F42E1BD6
-:100DD0003F0B2817390778F0AC014E5F5F4F24179F
-:100DE000350748F04E0F5F1F4093863F5093873F73
-:100DF0008193919302C0E0E0F0E0CF01DF91CF91C9
-:100E00001F910F910895CF93DF93009709F481C04C
-:100E1000FC01329712821382A091883FB091893FE2
-:100E2000109781F420813181820F931F2091863F9A
-:100E30003091873F2817390751F5E093863FF093AB
-:100E4000873F67C0ED0120E030E0CE17DF0740F4B8
-:100E50004A815B819E0141155105F1F0EA01F5CF10
-:100E6000C283D38340815181840F951FC817D9074E
-:100E700059F488819981840F951F0296808391830C
-:100E80008A819B81828393832115310529F4E09324
-:100E9000883FF093893F3DC0E901EA83FB83499194
-:100EA0005991C40FD51FEC17FD0761F48081918122
-:100EB000840F951F0296E90188839983828193812B
-:100EC0008A839B83E0E0F0E012968D919C911397CA
-:100ED000009719F0FD01DC01F7CF8D919C911197DE
-:100EE0009D012E5F3F4F820F931F2091863F3091CF
-:100EF000873F2817390769F4309729F41092883F03
-:100F00001092893F02C012821382A093863FB09351
-:100F1000873FDF91CF910895FB01DC0102C0019072
-:100F20000D9241505040D8F7089503D08081992701
-:100F30000895FC01E050FC4E0895262FAF93BF9317
-:100F4000E0E0F0E1328131FDFDCFDC01A050BC4E8C
-:100F50002C932DE924BF23E020830196BF91AF910C
-:060F60000895F894FFCF94
-:060F660000008A3F20009C
+:10056000443F7093453F08959F92AF92BF92CF92C0
+:10057000DF92EF92FF920F931F93CF93DF93EC01E3
+:10058000942EAC84BD84CE84DF84E884F9840A850B
+:100590001B852C813D814E815F8189819A81CBD2DF
+:1005A000A88CB98CCA8CDB8CEC88FD880E891F89DD
+:1005B000288939894A895B89692D89819A81C9D1BC
+:1005C00040E0692D89819A8141D2DF91CF911F91BD
+:1005D0000F91FF90EF90DF90CF90BF90AF909F90E2
+:1005E00008950F931F93CF93DF93EC018C010D5F60
+:1005F0001F4F4EE1B80180E090E05BDD60E0898153
+:100600009A8158D240E060E0CE01AEDF4EE1B80101
+:1006100080E290E04EDD41E061E0CE01A5DF42E006
+:1006200061E0CE01A1DF40E062E089819A810ED2D3
+:1006300040E062E089819A81E2D1DF91CF911F9100
+:100640000F910895CF93DF93EC01FB0190819923E3
+:1006500019F0913051F011C08EE1FB01DE011396CB
+:1006600001900D928A95E1F708C08EE1FB01DE0151
+:10067000919601900D928A95E1F782E0888380E05F
+:1006800090E0DF91CF910895CF93DF93EC018881C3
+:10069000813059F040E060E089819A81B0D141E039
+:1006A00061E089819A81ABD10AC041E060E0898133
+:1006B0009A81A5D140E061E089819A81A0D1DF9142
+:1006C000CF910895FC012381213071F028F02E3F55
+:1006D00099F02F3FC9F00895BC016D5F7F4F4EE147
+:1006E00080E090E0C3DC0895BC016F5D7F4F4EE178
+:1006F00080E290E0BBDC0895BC016D5F7F4F4EE16E
+:1007000080E090E0D6DC0895BC016F5D7F4F4EE144
+:1007100080E290E0CEDC0895CF93DF93FC0121814D
+:100720003281232BF9F00097E9F0EC0180818230CF
+:1007300031F41082CF01C6DFCE0153DF13C063E076
+:1007400080E0DADC019739F08881882339F018825B
+:10075000CE019ADF07C08881813021F081E0888353
+:10076000CE0192DFDF91CF9108950F931F93CF9326
+:10077000DF936115710509F489C0009709F486C0FB
+:10078000EC0169837A8362E273E0E0DE62E572E0A5
+:10079000CE0118DE8E010F5D1F4F4EE1B80180E0E3
+:1007A00090E087DC89A181508E3F08F069C008C0C5
+:1007B000919191509E3F20F02E173F07C9F703C03B
+:1007C000CE010FDF63C083E49DE0A0E0B0E08C8346
+:1007D0009D83AE83BF838AA39BA3ACA3BDA386EFF7
+:1007E0009CE2A0E0B0E088879987AA87BB878EA3A8
+:1007F0009FA3A8A7B9A78BE598E4A0E1B0E08C87F8
+:100800009D87AE87BF878AA79BA7ACA7BDA782E1BC
+:1008100090E0A0E0B0E0888B998BAA8BBB8B8EA771
+:100820009FA7A8ABB9AB1C8A1D8A1E8A1F8A1AAA69
+:100830001BAA1CAA1DAA81E090E0A0E0B0E0888F6E
+:10084000998FAA8FBB8F8EAB9FABA8AFB9AF80E457
+:1008500098E7ADE7B1E08D8F9E8FAF8FB8A38BAFD8
+:100860009CAFADAFBEAF4EE1BE016D5F7F4F80E08C
+:1008700090E0FCDB4EE1B80180E290E0F7DBA0CF36
+:10088000FE01B2969E01215C3F4F92CFDF91CF9146
+:100890001F910F910895CF93DF93CDB7DEB7A29745
+:1008A000CDBFDEBF80E090E004DD40E660E070E0B8
+:1008B000CE01019618DD41E951E0BE016F5F7F4F27
+:1008C000CE01049682D1BE016C5F7F4F86E49FE328
+:1008D0004CDF86E49FE320DFFCCF8F929F92AF92A4
+:1008E000BF92CF92DF92EF92FF920F931F93CF931D
+:1008F000DF93EC01862E5A0168017901C801019647
+:1009000011D2982E192FFC018192CF01A601B501B9
+:100910002AD3A70196012F5F3F4F4F4F5F4FEA81C8
+:10092000FB8101E0692D712F888199810995892DBD
+:10093000912F90D280E090E0DF91CF911F910F91A5
+:10094000FF90EF90DF90CF90BF90AF909F908F90EF
+:100950000895AF92BF92CF92DF92EF92FF920F93E2
+:100960001F93FC01437056895078378B208FF28E8D
+:10097000E38ED601C501072E7CE0B695A795979525
+:1009800087957A95D1F7702D83708295807F03705B
+:10099000802B818FB48AA58A452B468B613079F0F4
+:1009A00018F06230B9F020C0AF014C5E5F4F08E034
+:1009B00010E020E030E06AE2CF018FDF15C0AF0128
+:1009C0004C5E5F4F08E010E020E030E062E3CF01D2
+:1009D00084DF0AC0AF014C5E5F4F08E010E020E00A
+:1009E00030E06AE3CF0179DF80E090E01F910F9162
+:1009F000FF90EF90DF90CF90BF90AF9008950F934E
+:100A00001F93613051F018F0623069F011C0FC01A1
+:100A1000278140FB20F927830BC0FC01278140FB85
+:100A200021F9278305C0FC01278140FB22F9278398
+:100A3000AC01495F5F4F01E010E020E030E063E08F
+:100A40004CDF80E090E01F910F9108950F931F936A
+:100A5000FC01928540FB97F990799F649287613001
+:100A600079F018F06230B9F020C0AF01465F5F4FF7
+:100A700001E010E020E030E060E1CF012EDF15C0A2
+:100A8000AF01465F5F4F01E010E020E030E061E140
+:100A9000CF0123DF0AC0AF01465F5F4F01E010E0E6
+:100AA00020E030E062E1CF0118DF80E090E01F91AC
+:100AB0000F9108950F931F93662319F0613039F059
+:100AC0000AC0FC0121852B7F277F218704C0FC0100
+:100AD000218524602187AC01475F5F4F01E010E072
+:100AE00020E030E060EFF9DE80E090E01F910F91B0
+:100AF00008950F931F9331E0611101C030E0FC01B4
+:100B0000268D30FB25F9268F31E0411101C030E000
+:100B1000FC01268D30FB27F9268FAC01425E5F4F2A
+:100B200001E010E020E030E061EBD7DE80E090E013
+:100B30001F910F910895AF92BF92CF92DF92EF92E3
+:100B4000FF920F931F93CF93DF93EC0142708E853A
+:100B50008C7F482B4E873F87288BD801C701882779
+:100B60009927AF70BB27FA8AEB8A8A2F8F70898BFF
+:100B7000BC86AD86662319F0613061F015C008E0CF
+:100B800010E020E030E0AE01445F5F4F6AE1CE014B
+:100B9000A4DE0AC008E010E020E030E0AE01445FCF
+:100BA0005F4F62E2CE0199DE41E061E0CE01A1DF5C
+:100BB00080E090E0DF91CF911F910F91FF90EF9037
+:100BC000DF90CF90BF90AF900895EF92FF920F9378
+:100BD0001F93CF93DF931F92CDB7DEB7009709F431
+:100BE00091C06115710509F490C04115510509F4D2
+:100BF0008FC07C01DC016D937C93119712964D930D
+:100C00005C931397FC0134968BE1DF011D928A956A
+:100C1000E9F78FEF898301E010E020E030E0AE01DA
+:100C20004F5F5F4F63E0C70158DE80E8898301E0D2
+:100C300010E020E030E0AE014F5F5F4F60E1C701A0
+:100C40004CDE01E010E020E030E0AE014F5F5F4F8E
+:100C500061E1C70142DE01E010E020E030E0AE01DA
+:100C60004F5F5F4F62E1C70138DE01E010E020E036
+:100C700030E0AE014F5F5F4F63E1C7012EDE01E060
+:100C800010E020E030E0AE014F5F5F4F64E1C7014C
+:100C900024DE01E010E020E030E0AE014F5F5F4F66
+:100CA00065E1C7011ADE01E010E020E030E0AE01AE
+:100CB0004F5F5F4F66E1C70110DE01E010E020E00A
+:100CC00030E0AE014F5F5F4F67E1C70106DE80ECA9
+:100CD000898301E010E020E030E0AE014F5F5F4F1C
+:100CE00067EBC701FADD80E4898301E010E020E0D2
+:100CF00030E0AE014F5F5F4F6BEBC701EEDD80E090
+:100D000090E008C08FEF9FEF05C08FEF9FEF02C00C
+:100D10008FEF9FEF0F90DF91CF911F910F91FF9079
+:100D2000EF9008950F931F93CF93DF938230910537
+:100D300010F482E090E0E091873FF091883F20E05E
+:100D400030E0A0E0B0E0309719F14081518102819C
+:100D5000138148175907C8F08417950769F410974D
+:100D600031F012960C93129713961C9327C00093A0
+:100D7000873F1093883F22C02115310519F0421793
+:100D8000530718F49A01BD01EF01DF01F801DBCF31
+:100D900021153105F9F0281B390B2430310580F479
+:100DA0008A819B816115710521F0FB018283938308
+:100DB00004C08093873F9093883FFE01329644C0E1
+:100DC000FE01E20FF31F8193919322503109288392
+:100DD00039833AC02091853F3091863F232B41F4DF
+:100DE0002091023F3091033F2093853F3093863F0F
+:100DF0002091003F3091013F2115310541F42DB77D
+:100E00003EB74091043F5091053F241B350BE091C4
+:100E1000853FF091863FE217F307A0F42E1B3F0BAE
+:100E20002817390778F0AC014E5F5F4F241735075C
+:100E300048F04E0F5F1F4093853F5093863F81934C
+:100E4000919302C0E0E0F0E0CF01DF91CF911F91DC
+:100E50000F910895CF93DF93009709F481C0FC01AF
+:100E6000329712821382A091873FB091883F1097EA
+:100E700081F420813181820F931F2091853F309131
+:100E8000863F2817390751F5E093853FF093863F59
+:100E900067C0ED0120E030E0CE17DF0740F44A8163
+:100EA0005B819E0141155105F1F0EA01F5CFC28346
+:100EB000D38340815181840F951FC817D90759F4F6
+:100EC00088819981840F951F0296808391838A81FE
+:100ED0009B81828393832115310529F4E093873F19
+:100EE000F093883F3DC0E901EA83FB834991599122
+:100EF000C40FD51FEC17FD0761F480819181840F29
+:100F0000951F0296E90188839983828193818A8360
+:100F10009B83E0E0F0E012968D919C9113970097EF
+:100F200019F0FD01DC01F7CF8D919C9111979D0186
+:100F30002E5F3F4F820F931F2091853F3091863F58
+:100F40002817390769F4309729F41092873F1092D7
+:100F5000883F02C012821382A093853FB093863FE0
+:100F6000DF91CF910895FB01DC0102C001900D9249
+:100F700041505040D8F7089503D0808199270895B3
+:100F8000FC01E050FC4E0895262FAF93BF93E0E0A4
+:100F9000F0E1328131FDFDCFDC01A050BC4E2C933D
+:100FA0002DE924BF23E020830196BF91AF910895DE
+:040FB000F894FFCFE3
+:060FB4000000893F20004F
 :00000001FF
diff --git a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.lss b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.lss
index b9a181c..62cab18 100644
--- a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.lss
+++ b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.lss
@@ -3,31 +3,31 @@ storno_cqp6xx_digital_xtal.elf:     file format elf32-avr
 
 Sections:
 Idx Name          Size      VMA       LMA       File off  Algn
-  0 .data         00000006  00803f00  00000f66  00000ffa  2**0
+  0 .data         00000006  00803f00  00000fb4  00001048  2**0
                   CONTENTS, ALLOC, LOAD, DATA
-  1 .text         00000f66  00000000  00000000  00000094  2**1
+  1 .text         00000fb4  00000000  00000000  00000094  2**1
                   CONTENTS, ALLOC, LOAD, READONLY, CODE
-  2 .bss          00000084  00803f06  00803f06  00001000  2**0
+  2 .bss          00000083  00803f06  00803f06  0000104e  2**0
                   ALLOC
-  3 .comment      00000030  00000000  00000000  00001000  2**0
+  3 .comment      00000030  00000000  00000000  0000104e  2**0
                   CONTENTS, READONLY
-  4 .note.gnu.avr.deviceinfo 0000003c  00000000  00000000  00001030  2**2
+  4 .note.gnu.avr.deviceinfo 0000003c  00000000  00000000  00001080  2**2
                   CONTENTS, READONLY
-  5 .debug_aranges 00000238  00000000  00000000  00001070  2**3
+  5 .debug_aranges 00000240  00000000  00000000  000010c0  2**3
                   CONTENTS, READONLY, DEBUGGING
-  6 .debug_info   00004ff6  00000000  00000000  000012a8  2**0
+  6 .debug_info   00004fdf  00000000  00000000  00001300  2**0
                   CONTENTS, READONLY, DEBUGGING
-  7 .debug_abbrev 00001d79  00000000  00000000  0000629e  2**0
+  7 .debug_abbrev 00001d48  00000000  00000000  000062df  2**0
                   CONTENTS, READONLY, DEBUGGING
-  8 .debug_line   00001678  00000000  00000000  00008017  2**0
+  8 .debug_line   00001696  00000000  00000000  00008027  2**0
                   CONTENTS, READONLY, DEBUGGING
-  9 .debug_frame  000005d8  00000000  00000000  00009690  2**2
+  9 .debug_frame  000005f4  00000000  00000000  000096c0  2**2
                   CONTENTS, READONLY, DEBUGGING
- 10 .debug_str    00002145  00000000  00000000  00009c68  2**0
+ 10 .debug_str    00002120  00000000  00000000  00009cb4  2**0
                   CONTENTS, READONLY, DEBUGGING
- 11 .debug_loc    00001f43  00000000  00000000  0000bdad  2**0
+ 11 .debug_loc    00001fe7  00000000  00000000  0000bdd4  2**0
                   CONTENTS, READONLY, DEBUGGING
- 12 .debug_ranges 000001c0  00000000  00000000  0000dcf0  2**0
+ 12 .debug_ranges 000001c8  00000000  00000000  0000ddbb  2**0
                   CONTENTS, READONLY, DEBUGGING
 
 Disassembly of section .text:
@@ -78,7 +78,7 @@ Disassembly of section .text:
   48:	1d 92       	st	X+, r1
 
 0000004a <.do_clear_bss_start>:
-  4a:	aa 38       	cpi	r26, 0x8A	; 138
+  4a:	a9 38       	cpi	r26, 0x89	; 137
   4c:	b2 07       	cpc	r27, r18
   4e:	e1 f7       	brne	.-8      	; 0x48 <.do_clear_bss_loop>
 
@@ -86,7 +86,7 @@ Disassembly of section .text:
   50:	1f e3       	ldi	r17, 0x3F	; 63
   52:	a0 e0       	ldi	r26, 0x00	; 0
   54:	bf e3       	ldi	r27, 0x3F	; 63
-  56:	e6 e6       	ldi	r30, 0x66	; 102
+  56:	e4 eb       	ldi	r30, 0xB4	; 180
   58:	ff e0       	ldi	r31, 0x0F	; 15
   5a:	02 c0       	rjmp	.+4      	; 0x60 <__do_copy_data+0x10>
   5c:	05 90       	lpm	r0, Z+
@@ -94,8 +94,8 @@ Disassembly of section .text:
   60:	a6 30       	cpi	r26, 0x06	; 6
   62:	b1 07       	cpc	r27, r17
   64:	d9 f7       	brne	.-10     	; 0x5c <__do_copy_data+0xc>
-  66:	f0 d3       	rcall	.+2016   	; 0x848 <main>
-  68:	7c c7       	rjmp	.+3832   	; 0xf62 <_exit>
+  66:	17 d4       	rcall	.+2094   	; 0x896 <main>
+  68:	a3 c7       	rjmp	.+3910   	; 0xfb0 <_exit>
 
 0000006a <__bad_interrupt>:
   6a:	ca cf       	rjmp	.-108    	; 0x0 <__vectors>
@@ -136,7 +136,7 @@ void cm_EEPROM_write(uint8_t *address, uint8_t *data, uint8_t length) {
   94:	61 91       	ld	r22, Z+
   96:	8f 01       	movw	r16, r30
   98:	ce 01       	movw	r24, r28
-  9a:	4f d7       	rcall	.+3742   	; 0xf3a <eeprom_write_byte>
+  9a:	76 d7       	rcall	.+3820   	; 0xf88 <eeprom_write_byte>
   9c:	21 96       	adiw	r28, 0x01	; 1
 #include <avr/eeprom.h>
 
@@ -188,7 +188,7 @@ void cm_EEPROM_read(uint8_t* address, uint8_t *data, uint8_t length) {
   d6:	f7 1e       	adc	r15, r23
 		data[i] = eeprom_read_byte(address+i);
   d8:	ce 01       	movw	r24, r28
-  da:	27 d7       	rcall	.+3662   	; 0xf2a <eeprom_read_byte>
+  da:	4e d7       	rcall	.+3740   	; 0xf78 <eeprom_read_byte>
   dc:	f8 01       	movw	r30, r16
   de:	81 93       	st	Z+, r24
   e0:	8f 01       	movw	r16, r30
@@ -1241,1443 +1241,1636 @@ void cm_MsgCompleteEvt_Register(void *msg_cmplete_evt_inst, Get_msgComplete_Even
  562:	70 93 45 3f 	sts	0x3F45, r23	; 0x803f45 <s_msg_cmplete_evt_fpt+0x1>
  566:	08 95       	ret
 
-00000568 <cqm6xx_app_updateOsc>:
-	// Send status back maybe.. 
+00000568 <cqm_setPLLParam>:
+		if(inst == NULL)return 1;
+		
+		return 0;
+} 
+
+static void cqm_setPLLParam(storno_xtal_app_t *inst, si5351_PLLs pll_num, si5351_Outputs output){
+ 568:	9f 92       	push	r9
+ 56a:	af 92       	push	r10
+ 56c:	bf 92       	push	r11
+ 56e:	cf 92       	push	r12
+ 570:	df 92       	push	r13
+ 572:	ef 92       	push	r14
+ 574:	ff 92       	push	r15
+ 576:	0f 93       	push	r16
+ 578:	1f 93       	push	r17
+ 57a:	cf 93       	push	r28
+ 57c:	df 93       	push	r29
+ 57e:	ec 01       	movw	r28, r24
+ 580:	94 2e       	mov	r9, r20
+	
+	cm_setPllParamRaw(inst->si5351_dev,pll_num, inst->plla_param_data.MSNx_P1, inst->plla_param_data.MSNx_P2, inst->plla_param_data.MSNx_P3);
+ 582:	ac 84       	ldd	r10, Y+12	; 0x0c
+ 584:	bd 84       	ldd	r11, Y+13	; 0x0d
+ 586:	ce 84       	ldd	r12, Y+14	; 0x0e
+ 588:	df 84       	ldd	r13, Y+15	; 0x0f
+ 58a:	e8 84       	ldd	r14, Y+8	; 0x08
+ 58c:	f9 84       	ldd	r15, Y+9	; 0x09
+ 58e:	0a 85       	ldd	r16, Y+10	; 0x0a
+ 590:	1b 85       	ldd	r17, Y+11	; 0x0b
+ 592:	2c 81       	ldd	r18, Y+4	; 0x04
+ 594:	3d 81       	ldd	r19, Y+5	; 0x05
+ 596:	4e 81       	ldd	r20, Y+6	; 0x06
+ 598:	5f 81       	ldd	r21, Y+7	; 0x07
+ 59a:	89 81       	ldd	r24, Y+1	; 0x01
+ 59c:	9a 81       	ldd	r25, Y+2	; 0x02
+ 59e:	cb d2       	rcall	.+1430   	; 0xb36 <cm_setPllParamRaw>
+	//_delay_ms(1);
+	cm_setOutputMultiSynthRaw(inst->si5351_dev,output, inst->plla_param_data.MSx_P1, inst->plla_param_data.MSx_P2, inst->plla_param_data.MSx_P3);
+ 5a0:	a8 8c       	ldd	r10, Y+24	; 0x18
+ 5a2:	b9 8c       	ldd	r11, Y+25	; 0x19
+ 5a4:	ca 8c       	ldd	r12, Y+26	; 0x1a
+ 5a6:	db 8c       	ldd	r13, Y+27	; 0x1b
+ 5a8:	ec 88       	ldd	r14, Y+20	; 0x14
+ 5aa:	fd 88       	ldd	r15, Y+21	; 0x15
+ 5ac:	0e 89       	ldd	r16, Y+22	; 0x16
+ 5ae:	1f 89       	ldd	r17, Y+23	; 0x17
+ 5b0:	28 89       	ldd	r18, Y+16	; 0x10
+ 5b2:	39 89       	ldd	r19, Y+17	; 0x11
+ 5b4:	4a 89       	ldd	r20, Y+18	; 0x12
+ 5b6:	5b 89       	ldd	r21, Y+19	; 0x13
+ 5b8:	69 2d       	mov	r22, r9
+ 5ba:	89 81       	ldd	r24, Y+1	; 0x01
+ 5bc:	9a 81       	ldd	r25, Y+2	; 0x02
+ 5be:	c9 d1       	rcall	.+914    	; 0x952 <cm_setOutputMultiSynthRaw>
+	//_delay_ms(1);
+	cm_setCLKControl(inst->si5351_dev,output,SI5351_CLK_POWER_UP);
+ 5c0:	40 e0       	ldi	r20, 0x00	; 0
+ 5c2:	69 2d       	mov	r22, r9
+ 5c4:	89 81       	ldd	r24, Y+1	; 0x01
+ 5c6:	9a 81       	ldd	r25, Y+2	; 0x02
+ 5c8:	41 d2       	rcall	.+1154   	; 0xa4c <cm_setCLKControl>
 	
-	//Force state machine to load new settings from eeprom:
-	inst->state_next = STORNO_APP_PROGRAM_OSC;
 	
 }
- 568:	cf 93       	push	r28
- 56a:	df 93       	push	r29
- 56c:	fc 01       	movw	r30, r24
- 56e:	82 81       	ldd	r24, Z+2	; 0x02
- 570:	93 81       	ldd	r25, Z+3	; 0x03
- 572:	00 97       	sbiw	r24, 0x00	; 0
- 574:	e9 f0       	breq	.+58     	; 0x5b0 <cqm6xx_app_updateOsc+0x48>
- 576:	30 97       	sbiw	r30, 0x00	; 0
- 578:	d9 f0       	breq	.+54     	; 0x5b0 <cqm6xx_app_updateOsc+0x48>
- 57a:	21 81       	ldd	r18, Z+1	; 0x01
- 57c:	30 81       	ld	r19, Z
- 57e:	23 17       	cp	r18, r19
- 580:	b9 f0       	breq	.+46     	; 0x5b0 <cqm6xx_app_updateOsc+0x48>
- 582:	ef 01       	movw	r28, r30
- 584:	21 30       	cpi	r18, 0x01	; 1
- 586:	19 f0       	breq	.+6      	; 0x58e <cqm6xx_app_updateOsc+0x26>
- 588:	22 30       	cpi	r18, 0x02	; 2
- 58a:	51 f0       	breq	.+20     	; 0x5a0 <cqm6xx_app_updateOsc+0x38>
- 58c:	11 c0       	rjmp	.+34     	; 0x5b0 <cqm6xx_app_updateOsc+0x48>
- 58e:	40 e0       	ldi	r20, 0x00	; 0
- 590:	60 e0       	ldi	r22, 0x00	; 0
- 592:	0e d2       	rcall	.+1052   	; 0x9b0 <cm_setOutputEnable>
- 594:	41 e0       	ldi	r20, 0x01	; 1
- 596:	61 e0       	ldi	r22, 0x01	; 1
- 598:	8a 81       	ldd	r24, Y+2	; 0x02
- 59a:	9b 81       	ldd	r25, Y+3	; 0x03
- 59c:	09 d2       	rcall	.+1042   	; 0x9b0 <cm_setOutputEnable>
- 59e:	08 c0       	rjmp	.+16     	; 0x5b0 <cqm6xx_app_updateOsc+0x48>
- 5a0:	41 e0       	ldi	r20, 0x01	; 1
- 5a2:	60 e0       	ldi	r22, 0x00	; 0
- 5a4:	05 d2       	rcall	.+1034   	; 0x9b0 <cm_setOutputEnable>
- 5a6:	40 e0       	ldi	r20, 0x00	; 0
- 5a8:	61 e0       	ldi	r22, 0x01	; 1
- 5aa:	8a 81       	ldd	r24, Y+2	; 0x02
- 5ac:	9b 81       	ldd	r25, Y+3	; 0x03
- 5ae:	00 d2       	rcall	.+1024   	; 0x9b0 <cm_setOutputEnable>
- 5b0:	df 91       	pop	r29
- 5b2:	cf 91       	pop	r28
- 5b4:	08 95       	ret
+ 5ca:	df 91       	pop	r29
+ 5cc:	cf 91       	pop	r28
+ 5ce:	1f 91       	pop	r17
+ 5d0:	0f 91       	pop	r16
+ 5d2:	ff 90       	pop	r15
+ 5d4:	ef 90       	pop	r14
+ 5d6:	df 90       	pop	r13
+ 5d8:	cf 90       	pop	r12
+ 5da:	bf 90       	pop	r11
+ 5dc:	af 90       	pop	r10
+ 5de:	9f 90       	pop	r9
+ 5e0:	08 95       	ret
 
-000005b6 <cqm_setPLLParam>:
- 5b6:	9f 92       	push	r9
- 5b8:	af 92       	push	r10
- 5ba:	bf 92       	push	r11
- 5bc:	cf 92       	push	r12
- 5be:	df 92       	push	r13
- 5c0:	ef 92       	push	r14
- 5c2:	ff 92       	push	r15
- 5c4:	0f 93       	push	r16
- 5c6:	1f 93       	push	r17
- 5c8:	cf 93       	push	r28
- 5ca:	df 93       	push	r29
- 5cc:	ec 01       	movw	r28, r24
- 5ce:	94 2e       	mov	r9, r20
- 5d0:	ad 84       	ldd	r10, Y+13	; 0x0d
- 5d2:	be 84       	ldd	r11, Y+14	; 0x0e
- 5d4:	cf 84       	ldd	r12, Y+15	; 0x0f
- 5d6:	d8 88       	ldd	r13, Y+16	; 0x10
- 5d8:	e9 84       	ldd	r14, Y+9	; 0x09
- 5da:	fa 84       	ldd	r15, Y+10	; 0x0a
- 5dc:	0b 85       	ldd	r16, Y+11	; 0x0b
- 5de:	1c 85       	ldd	r17, Y+12	; 0x0c
- 5e0:	2d 81       	ldd	r18, Y+5	; 0x05
- 5e2:	3e 81       	ldd	r19, Y+6	; 0x06
- 5e4:	4f 81       	ldd	r20, Y+7	; 0x07
- 5e6:	58 85       	ldd	r21, Y+8	; 0x08
- 5e8:	8a 81       	ldd	r24, Y+2	; 0x02
- 5ea:	9b 81       	ldd	r25, Y+3	; 0x03
- 5ec:	7d d2       	rcall	.+1274   	; 0xae8 <cm_setPllParamRaw>
- 5ee:	a9 8c       	ldd	r10, Y+25	; 0x19
- 5f0:	ba 8c       	ldd	r11, Y+26	; 0x1a
- 5f2:	cb 8c       	ldd	r12, Y+27	; 0x1b
- 5f4:	dc 8c       	ldd	r13, Y+28	; 0x1c
- 5f6:	ed 88       	ldd	r14, Y+21	; 0x15
- 5f8:	fe 88       	ldd	r15, Y+22	; 0x16
- 5fa:	0f 89       	ldd	r16, Y+23	; 0x17
- 5fc:	18 8d       	ldd	r17, Y+24	; 0x18
- 5fe:	29 89       	ldd	r18, Y+17	; 0x11
- 600:	3a 89       	ldd	r19, Y+18	; 0x12
- 602:	4b 89       	ldd	r20, Y+19	; 0x13
- 604:	5c 89       	ldd	r21, Y+20	; 0x14
- 606:	69 2d       	mov	r22, r9
- 608:	8a 81       	ldd	r24, Y+2	; 0x02
- 60a:	9b 81       	ldd	r25, Y+3	; 0x03
- 60c:	7b d1       	rcall	.+758    	; 0x904 <cm_setOutputMultiSynthRaw>
- 60e:	40 e0       	ldi	r20, 0x00	; 0
- 610:	69 2d       	mov	r22, r9
- 612:	8a 81       	ldd	r24, Y+2	; 0x02
- 614:	9b 81       	ldd	r25, Y+3	; 0x03
- 616:	f3 d1       	rcall	.+998    	; 0x9fe <cm_setCLKControl>
- 618:	df 91       	pop	r29
- 61a:	cf 91       	pop	r28
- 61c:	1f 91       	pop	r17
- 61e:	0f 91       	pop	r16
- 620:	ff 90       	pop	r15
- 622:	ef 90       	pop	r14
- 624:	df 90       	pop	r13
- 626:	cf 90       	pop	r12
- 628:	bf 90       	pop	r11
- 62a:	af 90       	pop	r10
- 62c:	9f 90       	pop	r9
- 62e:	08 95       	ret
+000005e2 <cqm6xx_app_loadPLLParam>:
+static void cqm6xx_app_loadPLLParam(storno_xtal_app_t *inst){
+ 5e2:	0f 93       	push	r16
+ 5e4:	1f 93       	push	r17
+ 5e6:	cf 93       	push	r28
+ 5e8:	df 93       	push	r29
+ 5ea:	ec 01       	movw	r28, r24
+	
+	// Read settings for PLLA first
+	cm_EEPROM_read((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->plla_param_data,sizeof(storno_pll_param_msg));
+ 5ec:	8c 01       	movw	r16, r24
+ 5ee:	0d 5f       	subi	r16, 0xFD	; 253
+ 5f0:	1f 4f       	sbci	r17, 0xFF	; 255
+ 5f2:	4e e1       	ldi	r20, 0x1E	; 30
+ 5f4:	b8 01       	movw	r22, r16
+ 5f6:	80 e0       	ldi	r24, 0x00	; 0
+ 5f8:	90 e0       	ldi	r25, 0x00	; 0
+ 5fa:	5b dd       	rcall	.-1354   	; 0xb2 <cm_EEPROM_read>
+	//_delay_ms(1);
+	cm_setInputSource(inst->si5351_dev, SI5351_CLK_SOURCE_XTAL);
+ 5fc:	60 e0       	ldi	r22, 0x00	; 0
+ 5fe:	89 81       	ldd	r24, Y+1	; 0x01
+ 600:	9a 81       	ldd	r25, Y+2	; 0x02
+ 602:	58 d2       	rcall	.+1200   	; 0xab4 <cm_setInputSource>
+	//_delay_ms(1);
+	
+	
+	cqm_setPLLParam(inst, SI5351_PLL_A, SI5351_OUTPUT_0);
+ 604:	40 e0       	ldi	r20, 0x00	; 0
+ 606:	60 e0       	ldi	r22, 0x00	; 0
+ 608:	ce 01       	movw	r24, r28
+ 60a:	ae df       	rcall	.-164    	; 0x568 <cqm_setPLLParam>
+	//_delay_ms(1);
+	
+	
+	cm_EEPROM_read((uint8_t*)PLLB_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->plla_param_data,sizeof(storno_pll_param_msg));
+ 60c:	4e e1       	ldi	r20, 0x1E	; 30
+ 60e:	b8 01       	movw	r22, r16
+ 610:	80 e2       	ldi	r24, 0x20	; 32
+ 612:	90 e0       	ldi	r25, 0x00	; 0
+ 614:	4e dd       	rcall	.-1380   	; 0xb2 <cm_EEPROM_read>
+	//_delay_ms(1);
+	cqm_setPLLParam(inst, SI5351_PLL_B, SI5351_OUTPUT_1);
+ 616:	41 e0       	ldi	r20, 0x01	; 1
+ 618:	61 e0       	ldi	r22, 0x01	; 1
+ 61a:	ce 01       	movw	r24, r28
+ 61c:	a5 df       	rcall	.-182    	; 0x568 <cqm_setPLLParam>
+	
+	
+	// Set third output to crystal freq for calibration!
+	cqm_setPLLParam(inst, SI5351_PLL_B, SI5351_OUTPUT_2);
+ 61e:	42 e0       	ldi	r20, 0x02	; 2
+ 620:	61 e0       	ldi	r22, 0x01	; 1
+ 622:	ce 01       	movw	r24, r28
+ 624:	a1 df       	rcall	.-190    	; 0x568 <cqm_setPLLParam>
+	cm_setCLKControl(inst->si5351_dev, SI5351_OUTPUT_2,SI5351_CLK_POWER_UP);
+ 626:	40 e0       	ldi	r20, 0x00	; 0
+ 628:	62 e0       	ldi	r22, 0x02	; 2
+ 62a:	89 81       	ldd	r24, Y+1	; 0x01
+ 62c:	9a 81       	ldd	r25, Y+2	; 0x02
+ 62e:	0e d2       	rcall	.+1052   	; 0xa4c <cm_setCLKControl>
+	//_delay_ms(1);
+	cm_setOutputEnable(inst->si5351_dev,SI5351_OUTPUT_2,SI5351_OUTPUT_ENABLE);
+ 630:	40 e0       	ldi	r20, 0x00	; 0
+ 632:	62 e0       	ldi	r22, 0x02	; 2
+ 634:	89 81       	ldd	r24, Y+1	; 0x01
+ 636:	9a 81       	ldd	r25, Y+2	; 0x02
+ 638:	e2 d1       	rcall	.+964    	; 0x9fe <cm_setOutputEnable>
 
-00000630 <uart_rx_event>:
- 630:	fb 01       	movw	r30, r22
- 632:	20 81       	ld	r18, Z
- 634:	22 23       	and	r18, r18
- 636:	19 f0       	breq	.+6      	; 0x63e <uart_rx_event+0xe>
- 638:	21 30       	cpi	r18, 0x01	; 1
- 63a:	51 f0       	breq	.+20     	; 0x650 <uart_rx_event+0x20>
- 63c:	11 c0       	rjmp	.+34     	; 0x660 <uart_rx_event+0x30>
- 63e:	dc 01       	movw	r26, r24
- 640:	14 96       	adiw	r26, 0x04	; 4
- 642:	8e e1       	ldi	r24, 0x1E	; 30
- 644:	fb 01       	movw	r30, r22
- 646:	01 90       	ld	r0, Z+
- 648:	0d 92       	st	X+, r0
- 64a:	8a 95       	dec	r24
- 64c:	e1 f7       	brne	.-8      	; 0x646 <uart_rx_event+0x16>
- 64e:	08 c0       	rjmp	.+16     	; 0x660 <uart_rx_event+0x30>
- 650:	dc 01       	movw	r26, r24
- 652:	92 96       	adiw	r26, 0x22	; 34
- 654:	8e e1       	ldi	r24, 0x1E	; 30
- 656:	fb 01       	movw	r30, r22
- 658:	01 90       	ld	r0, Z+
- 65a:	0d 92       	st	X+, r0
- 65c:	8a 95       	dec	r24
- 65e:	e1 f7       	brne	.-8      	; 0x658 <uart_rx_event+0x28>
- 660:	80 e0       	ldi	r24, 0x00	; 0
- 662:	90 e0       	ldi	r25, 0x00	; 0
- 664:	08 95       	ret
+	
+	
+}
+ 63a:	df 91       	pop	r29
+ 63c:	cf 91       	pop	r28
+ 63e:	1f 91       	pop	r17
+ 640:	0f 91       	pop	r16
+ 642:	08 95       	ret
 
-00000666 <cqm6xx_app_statemachine>:
- 666:	0f 93       	push	r16
- 668:	1f 93       	push	r17
- 66a:	cf 93       	push	r28
- 66c:	df 93       	push	r29
- 66e:	fc 01       	movw	r30, r24
- 670:	22 81       	ldd	r18, Z+2	; 0x02
- 672:	33 81       	ldd	r19, Z+3	; 0x03
- 674:	23 2b       	or	r18, r19
- 676:	09 f4       	brne	.+2      	; 0x67a <cqm6xx_app_statemachine+0x14>
- 678:	4d c0       	rjmp	.+154    	; 0x714 <cqm6xx_app_statemachine+0xae>
- 67a:	00 97       	sbiw	r24, 0x00	; 0
- 67c:	09 f4       	brne	.+2      	; 0x680 <cqm6xx_app_statemachine+0x1a>
- 67e:	4a c0       	rjmp	.+148    	; 0x714 <cqm6xx_app_statemachine+0xae>
- 680:	ec 01       	movw	r28, r24
- 682:	81 81       	ldd	r24, Z+1	; 0x01
- 684:	81 30       	cpi	r24, 0x01	; 1
- 686:	79 f1       	breq	.+94     	; 0x6e6 <cqm6xx_app_statemachine+0x80>
- 688:	18 f0       	brcs	.+6      	; 0x690 <cqm6xx_app_statemachine+0x2a>
- 68a:	82 30       	cpi	r24, 0x02	; 2
- 68c:	c1 f1       	breq	.+112    	; 0x6fe <cqm6xx_app_statemachine+0x98>
- 68e:	42 c0       	rjmp	.+132    	; 0x714 <cqm6xx_app_statemachine+0xae>
- 690:	10 82       	st	Z, r1
- 692:	8f 01       	movw	r16, r30
- 694:	0c 5f       	subi	r16, 0xFC	; 252
- 696:	1f 4f       	sbci	r17, 0xFF	; 255
- 698:	4e e1       	ldi	r20, 0x1E	; 30
- 69a:	b8 01       	movw	r22, r16
- 69c:	80 e0       	ldi	r24, 0x00	; 0
- 69e:	90 e0       	ldi	r25, 0x00	; 0
- 6a0:	08 dd       	rcall	.-1520   	; 0xb2 <cm_EEPROM_read>
- 6a2:	60 e0       	ldi	r22, 0x00	; 0
- 6a4:	8a 81       	ldd	r24, Y+2	; 0x02
- 6a6:	9b 81       	ldd	r25, Y+3	; 0x03
- 6a8:	de d1       	rcall	.+956    	; 0xa66 <cm_setInputSource>
- 6aa:	40 e0       	ldi	r20, 0x00	; 0
+00000644 <uart_rx_event>:
+	return 0;
+	
+	
+}
+
+int uart_rx_event(storno_xtal_app_t *inst, void *rxData){
+ 644:	cf 93       	push	r28
+ 646:	df 93       	push	r29
+ 648:	ec 01       	movw	r28, r24
+	
+	storno_pll_param_msg_header *msg = rxData;
+	
+	switch (msg->PLL_Ident){
+ 64a:	fb 01       	movw	r30, r22
+ 64c:	90 81       	ld	r25, Z
+ 64e:	99 23       	and	r25, r25
+ 650:	19 f0       	breq	.+6      	; 0x658 <uart_rx_event+0x14>
+ 652:	91 30       	cpi	r25, 0x01	; 1
+ 654:	51 f0       	breq	.+20     	; 0x66a <uart_rx_event+0x26>
+ 656:	11 c0       	rjmp	.+34     	; 0x67a <uart_rx_event+0x36>
+		
+		case MSG_PLLA_PARAM:
+			memcpy(&inst->plla_param_data,rxData,sizeof(storno_pll_param_msg));
+ 658:	8e e1       	ldi	r24, 0x1E	; 30
+ 65a:	fb 01       	movw	r30, r22
+ 65c:	de 01       	movw	r26, r28
+ 65e:	13 96       	adiw	r26, 0x03	; 3
+ 660:	01 90       	ld	r0, Z+
+ 662:	0d 92       	st	X+, r0
+ 664:	8a 95       	dec	r24
+ 666:	e1 f7       	brne	.-8      	; 0x660 <uart_rx_event+0x1c>
+			break;
+ 668:	08 c0       	rjmp	.+16     	; 0x67a <uart_rx_event+0x36>
+		
+		case MSG_PLLB_PARAM:
+			memcpy(&inst->pllb_param_data,rxData,sizeof(storno_pll_param_msg));
+ 66a:	8e e1       	ldi	r24, 0x1E	; 30
+ 66c:	fb 01       	movw	r30, r22
+ 66e:	de 01       	movw	r26, r28
+ 670:	91 96       	adiw	r26, 0x21	; 33
+ 672:	01 90       	ld	r0, Z+
+ 674:	0d 92       	st	X+, r0
+ 676:	8a 95       	dec	r24
+ 678:	e1 f7       	brne	.-8      	; 0x672 <uart_rx_event+0x2e>
+		
+	}
+	
+	// Add EepromWritePLLParameters to trigger to write setting to eeprom as soon as we can after ISR!
+	//cm_taskManager_addTaskToList(&inst->storno_xtal_task,(void*)EepromWritePLLParameters,inst);
+	inst->rtx_mode = STORNO_APP_PROGRAM_EEPROM;
+ 67a:	82 e0       	ldi	r24, 0x02	; 2
+ 67c:	88 83       	st	Y, r24
+	// Add write pll to list.. so the settings are updated immitialy
+	
+	return 0;
+	
+}
+ 67e:	80 e0       	ldi	r24, 0x00	; 0
+ 680:	90 e0       	ldi	r25, 0x00	; 0
+ 682:	df 91       	pop	r29
+ 684:	cf 91       	pop	r28
+ 686:	08 95       	ret
+
+00000688 <setRTXOscMode>:
+
+	
+	
+}
+
+void setRTXOscMode(storno_xtal_app_t *inst){
+ 688:	cf 93       	push	r28
+ 68a:	df 93       	push	r29
+ 68c:	ec 01       	movw	r28, r24
+	
+	if(inst->rtx_mode != STORNO_APP_TX_MODE){
+ 68e:	88 81       	ld	r24, Y
+ 690:	81 30       	cpi	r24, 0x01	; 1
+ 692:	59 f0       	breq	.+22     	; 0x6aa <setRTXOscMode+0x22>
+		
+		cm_setOutputEnable(inst->si5351_dev,SI5351_OUTPUT_0,SI5351_OUTPUT_ENABLE); // RX
+ 694:	40 e0       	ldi	r20, 0x00	; 0
+ 696:	60 e0       	ldi	r22, 0x00	; 0
+ 698:	89 81       	ldd	r24, Y+1	; 0x01
+ 69a:	9a 81       	ldd	r25, Y+2	; 0x02
+ 69c:	b0 d1       	rcall	.+864    	; 0x9fe <cm_setOutputEnable>
+		cm_setOutputEnable(inst->si5351_dev,SI5351_OUTPUT_1,SI5351_OUTPUT_DISABLE); // TX
+ 69e:	41 e0       	ldi	r20, 0x01	; 1
+ 6a0:	61 e0       	ldi	r22, 0x01	; 1
+ 6a2:	89 81       	ldd	r24, Y+1	; 0x01
+ 6a4:	9a 81       	ldd	r25, Y+2	; 0x02
+ 6a6:	ab d1       	rcall	.+854    	; 0x9fe <cm_setOutputEnable>
+ 6a8:	0a c0       	rjmp	.+20     	; 0x6be <setRTXOscMode+0x36>
+		
+	}else{
+		cm_setOutputEnable(inst->si5351_dev,SI5351_OUTPUT_0,SI5351_OUTPUT_DISABLE); // RX
+ 6aa:	41 e0       	ldi	r20, 0x01	; 1
  6ac:	60 e0       	ldi	r22, 0x00	; 0
- 6ae:	ce 01       	movw	r24, r28
- 6b0:	82 df       	rcall	.-252    	; 0x5b6 <cqm_setPLLParam>
- 6b2:	4e e1       	ldi	r20, 0x1E	; 30
- 6b4:	b8 01       	movw	r22, r16
- 6b6:	80 e2       	ldi	r24, 0x20	; 32
- 6b8:	90 e0       	ldi	r25, 0x00	; 0
- 6ba:	fb dc       	rcall	.-1546   	; 0xb2 <cm_EEPROM_read>
- 6bc:	41 e0       	ldi	r20, 0x01	; 1
- 6be:	61 e0       	ldi	r22, 0x01	; 1
- 6c0:	ce 01       	movw	r24, r28
- 6c2:	79 df       	rcall	.-270    	; 0x5b6 <cqm_setPLLParam>
- 6c4:	42 e0       	ldi	r20, 0x02	; 2
- 6c6:	61 e0       	ldi	r22, 0x01	; 1
- 6c8:	ce 01       	movw	r24, r28
- 6ca:	75 df       	rcall	.-278    	; 0x5b6 <cqm_setPLLParam>
- 6cc:	40 e0       	ldi	r20, 0x00	; 0
- 6ce:	62 e0       	ldi	r22, 0x02	; 2
- 6d0:	8a 81       	ldd	r24, Y+2	; 0x02
- 6d2:	9b 81       	ldd	r25, Y+3	; 0x03
- 6d4:	94 d1       	rcall	.+808    	; 0x9fe <cm_setCLKControl>
- 6d6:	40 e0       	ldi	r20, 0x00	; 0
- 6d8:	62 e0       	ldi	r22, 0x02	; 2
- 6da:	8a 81       	ldd	r24, Y+2	; 0x02
- 6dc:	9b 81       	ldd	r25, Y+3	; 0x03
- 6de:	68 d1       	rcall	.+720    	; 0x9b0 <cm_setOutputEnable>
- 6e0:	81 e0       	ldi	r24, 0x01	; 1
- 6e2:	89 83       	std	Y+1, r24	; 0x01
- 6e4:	17 c0       	rjmp	.+46     	; 0x714 <cqm6xx_app_statemachine+0xae>
- 6e6:	cf 01       	movw	r24, r30
- 6e8:	3f df       	rcall	.-386    	; 0x568 <cqm6xx_app_updateOsc>
- 6ea:	89 81       	ldd	r24, Y+1	; 0x01
- 6ec:	88 83       	st	Y, r24
- 6ee:	63 e0       	ldi	r22, 0x03	; 3
- 6f0:	80 e0       	ldi	r24, 0x00	; 0
- 6f2:	02 dd       	rcall	.-1532   	; 0xf8 <gpio_get_level>
- 6f4:	01 97       	sbiw	r24, 0x01	; 1
- 6f6:	71 f4       	brne	.+28     	; 0x714 <cqm6xx_app_statemachine+0xae>
- 6f8:	82 e0       	ldi	r24, 0x02	; 2
- 6fa:	89 83       	std	Y+1, r24	; 0x01
- 6fc:	0b c0       	rjmp	.+22     	; 0x714 <cqm6xx_app_statemachine+0xae>
- 6fe:	cf 01       	movw	r24, r30
- 700:	33 df       	rcall	.-410    	; 0x568 <cqm6xx_app_updateOsc>
- 702:	89 81       	ldd	r24, Y+1	; 0x01
- 704:	88 83       	st	Y, r24
- 706:	63 e0       	ldi	r22, 0x03	; 3
- 708:	80 e0       	ldi	r24, 0x00	; 0
- 70a:	f6 dc       	rcall	.-1556   	; 0xf8 <gpio_get_level>
- 70c:	89 2b       	or	r24, r25
- 70e:	11 f4       	brne	.+4      	; 0x714 <cqm6xx_app_statemachine+0xae>
- 710:	81 e0       	ldi	r24, 0x01	; 1
- 712:	89 83       	std	Y+1, r24	; 0x01
- 714:	df 91       	pop	r29
- 716:	cf 91       	pop	r28
- 718:	1f 91       	pop	r17
- 71a:	0f 91       	pop	r16
- 71c:	08 95       	ret
+ 6ae:	89 81       	ldd	r24, Y+1	; 0x01
+ 6b0:	9a 81       	ldd	r25, Y+2	; 0x02
+ 6b2:	a5 d1       	rcall	.+842    	; 0x9fe <cm_setOutputEnable>
+		cm_setOutputEnable(inst->si5351_dev,SI5351_OUTPUT_1,SI5351_OUTPUT_ENABLE); // TX
+ 6b4:	40 e0       	ldi	r20, 0x00	; 0
+ 6b6:	61 e0       	ldi	r22, 0x01	; 1
+ 6b8:	89 81       	ldd	r24, Y+1	; 0x01
+ 6ba:	9a 81       	ldd	r25, Y+2	; 0x02
+ 6bc:	a0 d1       	rcall	.+832    	; 0x9fe <cm_setOutputEnable>
+	}
+	
+}
+ 6be:	df 91       	pop	r29
+ 6c0:	cf 91       	pop	r28
+ 6c2:	08 95       	ret
 
-0000071e <cqm6xx_app_init>:
+000006c4 <EepromWritePLLParameters>:
+
+void EepromWritePLLParameters(storno_xtal_app_t *inst){
+	
+	//Burn settings into eeprom here:
+	switch(inst->plla_param_data.header.PLL_Ident){
+ 6c4:	fc 01       	movw	r30, r24
+ 6c6:	23 81       	ldd	r18, Z+3	; 0x03
+ 6c8:	21 30       	cpi	r18, 0x01	; 1
+ 6ca:	71 f0       	breq	.+28     	; 0x6e8 <EepromWritePLLParameters+0x24>
+ 6cc:	28 f0       	brcs	.+10     	; 0x6d8 <EepromWritePLLParameters+0x14>
+ 6ce:	2e 3f       	cpi	r18, 0xFE	; 254
+ 6d0:	99 f0       	breq	.+38     	; 0x6f8 <EepromWritePLLParameters+0x34>
+ 6d2:	2f 3f       	cpi	r18, 0xFF	; 255
+ 6d4:	c9 f0       	breq	.+50     	; 0x708 <EepromWritePLLParameters+0x44>
+ 6d6:	08 95       	ret
+		
+		case MSG_PLLA_PARAM:
+		cm_EEPROM_write((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t*)&(inst->plla_param_data), sizeof(storno_pll_param_msg));
+ 6d8:	bc 01       	movw	r22, r24
+ 6da:	6d 5f       	subi	r22, 0xFD	; 253
+ 6dc:	7f 4f       	sbci	r23, 0xFF	; 255
+ 6de:	4e e1       	ldi	r20, 0x1E	; 30
+ 6e0:	80 e0       	ldi	r24, 0x00	; 0
+ 6e2:	90 e0       	ldi	r25, 0x00	; 0
+ 6e4:	c3 dc       	rcall	.-1658   	; 0x6c <cm_EEPROM_write>
+		break;
+ 6e6:	08 95       	ret
+		
+		case MSG_PLLB_PARAM:
+		cm_EEPROM_write((uint8_t*)PLLB_SETTINGS_EEPROM_ADDR,(uint8_t*)&(inst->pllb_param_data), sizeof(storno_pll_param_msg));
+ 6e8:	bc 01       	movw	r22, r24
+ 6ea:	6f 5d       	subi	r22, 0xDF	; 223
+ 6ec:	7f 4f       	sbci	r23, 0xFF	; 255
+ 6ee:	4e e1       	ldi	r20, 0x1E	; 30
+ 6f0:	80 e2       	ldi	r24, 0x20	; 32
+ 6f2:	90 e0       	ldi	r25, 0x00	; 0
+ 6f4:	bb dc       	rcall	.-1674   	; 0x6c <cm_EEPROM_write>
+		break;
+ 6f6:	08 95       	ret
+		
+		case MSG_GET_PLLA_PARAM:
+		cm_EEPROM_read((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->plla_param_data,sizeof(storno_pll_param_msg));
+ 6f8:	bc 01       	movw	r22, r24
+ 6fa:	6d 5f       	subi	r22, 0xFD	; 253
+ 6fc:	7f 4f       	sbci	r23, 0xFF	; 255
+ 6fe:	4e e1       	ldi	r20, 0x1E	; 30
+ 700:	80 e0       	ldi	r24, 0x00	; 0
+ 702:	90 e0       	ldi	r25, 0x00	; 0
+ 704:	d6 dc       	rcall	.-1620   	; 0xb2 <cm_EEPROM_read>
+		break;
+ 706:	08 95       	ret
+		
+		case MSG_GET_PLLB_PARAM:
+		cm_EEPROM_read((uint8_t*)PLLB_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->pllb_param_data,sizeof(storno_pll_param_msg));
+ 708:	bc 01       	movw	r22, r24
+ 70a:	6f 5d       	subi	r22, 0xDF	; 223
+ 70c:	7f 4f       	sbci	r23, 0xFF	; 255
+ 70e:	4e e1       	ldi	r20, 0x1E	; 30
+ 710:	80 e2       	ldi	r24, 0x20	; 32
+ 712:	90 e0       	ldi	r25, 0x00	; 0
+ 714:	ce dc       	rcall	.-1636   	; 0xb2 <cm_EEPROM_read>
+ 716:	08 95       	ret
+
+00000718 <cqm6xx_app_taskHandler>:
+		
+	}
+	
+}
+
+void cqm6xx_app_taskHandler(storno_xtal_app_t *inst){
+ 718:	cf 93       	push	r28
+ 71a:	df 93       	push	r29
+#define PLLA_SETTINGS_EEPROM_ADDR 0x00 // addr 0
+#define PLLB_SETTINGS_EEPROM_ADDR 0x20 // addr 32 (64 bytes total memory)
+
+static uint8_t isStructValid(storno_xtal_app_t *inst){
+	
+		if(inst->si5351_dev == NULL) return 1;
+ 71c:	fc 01       	movw	r30, r24
+ 71e:	21 81       	ldd	r18, Z+1	; 0x01
+ 720:	32 81       	ldd	r19, Z+2	; 0x02
+ 722:	23 2b       	or	r18, r19
+ 724:	f9 f0       	breq	.+62     	; 0x764 <cqm6xx_app_taskHandler+0x4c>
+}
+
+void cqm6xx_app_taskHandler(storno_xtal_app_t *inst){
+	
+	// Check Struct
+	if(isStructValid(inst) != 0)return;
+ 726:	00 97       	sbiw	r24, 0x00	; 0
+ 728:	e9 f0       	breq	.+58     	; 0x764 <cqm6xx_app_taskHandler+0x4c>
+ 72a:	ec 01       	movw	r28, r24
+	
+	// Run next task:
+	//cm_taskManager_run_tasks(&inst->storno_xtal_task);
+	
+	// Save eeprom setting if we have to:
+	if(inst->rtx_mode == STORNO_APP_PROGRAM_EEPROM){
+ 72c:	80 81       	ld	r24, Z
+ 72e:	82 30       	cpi	r24, 0x02	; 2
+ 730:	31 f4       	brne	.+12     	; 0x73e <cqm6xx_app_taskHandler+0x26>
+		inst->rtx_mode = STORNO_APP_RX_MODE;
+ 732:	10 82       	st	Z, r1
+		EepromWritePLLParameters(inst);
+ 734:	cf 01       	movw	r24, r30
+ 736:	c6 df       	rcall	.-116    	; 0x6c4 <EepromWritePLLParameters>
+		cqm6xx_app_loadPLLParam(inst);
+ 738:	ce 01       	movw	r24, r28
+ 73a:	53 df       	rcall	.-346    	; 0x5e2 <cqm6xx_app_loadPLLParam>
+		return;
+ 73c:	13 c0       	rjmp	.+38     	; 0x764 <cqm6xx_app_taskHandler+0x4c>
+	}
+	
+	// If TX pin is not set, then turn on RX output on PLL and disable TX clock. Run setRTXOscMode once, so pll isnt constantly written to!!
+	if((gpio_get_level(GPIO_PORTA,GPIO_PIN_PTT) != GPIO_LEVEL_SET) && (inst->rtx_mode != STORNO_APP_RX_MODE)){
+ 73e:	63 e0       	ldi	r22, 0x03	; 3
+ 740:	80 e0       	ldi	r24, 0x00	; 0
+ 742:	da dc       	rcall	.-1612   	; 0xf8 <gpio_get_level>
+ 744:	01 97       	sbiw	r24, 0x01	; 1
+ 746:	39 f0       	breq	.+14     	; 0x756 <cqm6xx_app_taskHandler+0x3e>
+ 748:	88 81       	ld	r24, Y
+ 74a:	88 23       	and	r24, r24
+ 74c:	39 f0       	breq	.+14     	; 0x75c <cqm6xx_app_taskHandler+0x44>
+		
+		inst->rtx_mode = STORNO_APP_RX_MODE;
+ 74e:	18 82       	st	Y, r1
+		setRTXOscMode(inst);
+ 750:	ce 01       	movw	r24, r28
+ 752:	9a df       	rcall	.-204    	; 0x688 <setRTXOscMode>
+ 754:	07 c0       	rjmp	.+14     	; 0x764 <cqm6xx_app_taskHandler+0x4c>
+		//cm_taskManager_addTaskToList(&inst->storno_xtal_task,setRTXOscMode,inst);
+
+	}else if (inst->rtx_mode != STORNO_APP_TX_MODE){
+ 756:	88 81       	ld	r24, Y
+ 758:	81 30       	cpi	r24, 0x01	; 1
+ 75a:	21 f0       	breq	.+8      	; 0x764 <cqm6xx_app_taskHandler+0x4c>
+		inst->rtx_mode = STORNO_APP_TX_MODE;
+ 75c:	81 e0       	ldi	r24, 0x01	; 1
+ 75e:	88 83       	st	Y, r24
+		setRTXOscMode(inst);
+ 760:	ce 01       	movw	r24, r28
+ 762:	92 df       	rcall	.-220    	; 0x688 <setRTXOscMode>
+		//cm_taskManager_addTaskToList(&inst->storno_xtal_task,setRTXOscMode,inst);
+
+	}
+	
+}
+ 764:	df 91       	pop	r29
+ 766:	cf 91       	pop	r28
+ 768:	08 95       	ret
+
+0000076a <cqm6xx_app_init>:
 	
 	return 0;
 	
 }
 
 void cqm6xx_app_init(storno_xtal_app_t *inst, void *si5351_dev){
- 71e:	0f 93       	push	r16
- 720:	1f 93       	push	r17
- 722:	cf 93       	push	r28
- 724:	df 93       	push	r29
+ 76a:	0f 93       	push	r16
+ 76c:	1f 93       	push	r17
+ 76e:	cf 93       	push	r28
+ 770:	df 93       	push	r29
 	
 	if(si5351_dev == NULL) return;
- 726:	61 15       	cp	r22, r1
- 728:	71 05       	cpc	r23, r1
- 72a:	09 f4       	brne	.+2      	; 0x72e <cqm6xx_app_init+0x10>
- 72c:	88 c0       	rjmp	.+272    	; 0x83e <cqm6xx_app_init+0x120>
+ 772:	61 15       	cp	r22, r1
+ 774:	71 05       	cpc	r23, r1
+ 776:	09 f4       	brne	.+2      	; 0x77a <cqm6xx_app_init+0x10>
+ 778:	89 c0       	rjmp	.+274    	; 0x88c <cqm6xx_app_init+0x122>
 	if(inst == NULL)return;
- 72e:	00 97       	sbiw	r24, 0x00	; 0
- 730:	09 f4       	brne	.+2      	; 0x734 <cqm6xx_app_init+0x16>
- 732:	85 c0       	rjmp	.+266    	; 0x83e <cqm6xx_app_init+0x120>
- 734:	ec 01       	movw	r28, r24
-	
-	inst->state_next = STORNO_APP_PROGRAM_OSC;
- 736:	19 82       	std	Y+1, r1	; 0x01
-	inst->state_now = STORNO_APP_PROGRAM_OSC;
- 738:	18 82       	st	Y, r1
-	
+ 77a:	00 97       	sbiw	r24, 0x00	; 0
+ 77c:	09 f4       	brne	.+2      	; 0x780 <cqm6xx_app_init+0x16>
+ 77e:	86 c0       	rjmp	.+268    	; 0x88c <cqm6xx_app_init+0x122>
+ 780:	ec 01       	movw	r28, r24
 	inst->si5351_dev = si5351_dev;
- 73a:	6a 83       	std	Y+2, r22	; 0x02
- 73c:	7b 83       	std	Y+3, r23	; 0x03
+ 782:	69 83       	std	Y+1, r22	; 0x01
+ 784:	7a 83       	std	Y+2, r23	; 0x02
 	
 	cm_MsgCompleteEvt_Register(inst,(Get_msgComplete_Event_fpt)uart_rx_event);
- 73e:	68 e1       	ldi	r22, 0x18	; 24
- 740:	73 e0       	ldi	r23, 0x03	; 3
- 742:	04 df       	rcall	.-504    	; 0x54c <cm_MsgCompleteEvt_Register>
+ 786:	62 e2       	ldi	r22, 0x22	; 34
+ 788:	73 e0       	ldi	r23, 0x03	; 3
+ 78a:	e0 de       	rcall	.-576    	; 0x54c <cm_MsgCompleteEvt_Register>
 	cm_uart_init(inst,(get_UART_Event_fpt)cm_msg_DecodeMsg_Byte);
- 744:	62 e5       	ldi	r22, 0x52	; 82
- 746:	72 e0       	ldi	r23, 0x02	; 2
- 748:	ce 01       	movw	r24, r28
- 74a:	3c de       	rcall	.-904    	; 0x3c4 <cm_uart_init>
+ 78c:	62 e5       	ldi	r22, 0x52	; 82
+ 78e:	72 e0       	ldi	r23, 0x02	; 2
+ 790:	ce 01       	movw	r24, r28
+ 792:	18 de       	rcall	.-976    	; 0x3c4 <cm_uart_init>
 	
 }
 
 static int isEEPROMValid(storno_xtal_app_t *inst){
 	
 	cm_EEPROM_read((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->pllb_param_data,sizeof(storno_pll_param_msg));
- 74c:	8e 01       	movw	r16, r28
- 74e:	0e 5d       	subi	r16, 0xDE	; 222
- 750:	1f 4f       	sbci	r17, 0xFF	; 255
- 752:	4e e1       	ldi	r20, 0x1E	; 30
- 754:	b8 01       	movw	r22, r16
- 756:	80 e0       	ldi	r24, 0x00	; 0
- 758:	90 e0       	ldi	r25, 0x00	; 0
- 75a:	ab dc       	rcall	.-1706   	; 0xb2 <cm_EEPROM_read>
+ 794:	8e 01       	movw	r16, r28
+ 796:	0f 5d       	subi	r16, 0xDF	; 223
+ 798:	1f 4f       	sbci	r17, 0xFF	; 255
+ 79a:	4e e1       	ldi	r20, 0x1E	; 30
+ 79c:	b8 01       	movw	r22, r16
+ 79e:	80 e0       	ldi	r24, 0x00	; 0
+ 7a0:	90 e0       	ldi	r25, 0x00	; 0
+ 7a2:	87 dc       	rcall	.-1778   	; 0xb2 <cm_EEPROM_read>
 	
 	uint8_t *ptr = (void*)&inst->pllb_param_data;
 	
 	for (uint32_t idx = 0; idx < sizeof(storno_pll_param_msg); idx++ )
 	{
 		if ((*ptr != 0xff) && (*ptr != 0x00))
- 75c:	8a a1       	ldd	r24, Y+34	; 0x22
- 75e:	81 50       	subi	r24, 0x01	; 1
- 760:	8e 3f       	cpi	r24, 0xFE	; 254
- 762:	08 f0       	brcs	.+2      	; 0x766 <cqm6xx_app_init+0x48>
- 764:	66 c0       	rjmp	.+204    	; 0x832 <cqm6xx_app_init+0x114>
- 766:	6b c0       	rjmp	.+214    	; 0x83e <cqm6xx_app_init+0x120>
- 768:	91 91       	ld	r25, Z+
- 76a:	91 50       	subi	r25, 0x01	; 1
- 76c:	9e 3f       	cpi	r25, 0xFE	; 254
- 76e:	08 f4       	brcc	.+2      	; 0x772 <cqm6xx_app_init+0x54>
- 770:	66 c0       	rjmp	.+204    	; 0x83e <cqm6xx_app_init+0x120>
+ 7a4:	89 a1       	ldd	r24, Y+33	; 0x21
+ 7a6:	81 50       	subi	r24, 0x01	; 1
+ 7a8:	8e 3f       	cpi	r24, 0xFE	; 254
+ 7aa:	08 f0       	brcs	.+2      	; 0x7ae <cqm6xx_app_init+0x44>
+ 7ac:	69 c0       	rjmp	.+210    	; 0x880 <cqm6xx_app_init+0x116>
+ 7ae:	08 c0       	rjmp	.+16     	; 0x7c0 <cqm6xx_app_init+0x56>
+ 7b0:	91 91       	ld	r25, Z+
+ 7b2:	91 50       	subi	r25, 0x01	; 1
+ 7b4:	9e 3f       	cpi	r25, 0xFE	; 254
+ 7b6:	20 f0       	brcs	.+8      	; 0x7c0 <cqm6xx_app_init+0x56>
 	
 	cm_EEPROM_read((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->pllb_param_data,sizeof(storno_pll_param_msg));
 	
 	uint8_t *ptr = (void*)&inst->pllb_param_data;
 	
 	for (uint32_t idx = 0; idx < sizeof(storno_pll_param_msg); idx++ )
- 772:	2e 17       	cp	r18, r30
- 774:	3f 07       	cpc	r19, r31
- 776:	c1 f7       	brne	.-16     	; 0x768 <cqm6xx_app_init+0x4a>
+ 7b8:	2e 17       	cp	r18, r30
+ 7ba:	3f 07       	cpc	r19, r31
+ 7bc:	c9 f7       	brne	.-14     	; 0x7b0 <cqm6xx_app_init+0x46>
+ 7be:	03 c0       	rjmp	.+6      	; 0x7c6 <cqm6xx_app_init+0x5c>
+	if(!isEEPROMValid(inst)){
+		// If settings are somehow unvalid, then write default settings..
+		writeDefaultSettingsEEprom(inst);
+	}
+	
+	cqm6xx_app_loadPLLParam(inst);
+ 7c0:	ce 01       	movw	r24, r28
+ 7c2:	0f df       	rcall	.-482    	; 0x5e2 <cqm6xx_app_loadPLLParam>
+ 7c4:	63 c0       	rjmp	.+198    	; 0x88c <cqm6xx_app_init+0x122>
 
 static int writeDefaultSettingsEEprom(storno_xtal_app_t *inst){
 	
 	
 	//inst->pllb_param_data.PLL_Ident = inst->plla_param_data.PLL_Ident = 0;
 	inst->pllb_param_data.MSNx_P1 = inst->plla_param_data.MSNx_P1 = 3395;
- 778:	83 e4       	ldi	r24, 0x43	; 67
- 77a:	9d e0       	ldi	r25, 0x0D	; 13
- 77c:	a0 e0       	ldi	r26, 0x00	; 0
- 77e:	b0 e0       	ldi	r27, 0x00	; 0
- 780:	8d 83       	std	Y+5, r24	; 0x05
- 782:	9e 83       	std	Y+6, r25	; 0x06
- 784:	af 83       	std	Y+7, r26	; 0x07
- 786:	b8 87       	std	Y+8, r27	; 0x08
- 788:	8b a3       	std	Y+35, r24	; 0x23
- 78a:	9c a3       	std	Y+36, r25	; 0x24
- 78c:	ad a3       	std	Y+37, r26	; 0x25
- 78e:	be a3       	std	Y+38, r27	; 0x26
+ 7c6:	83 e4       	ldi	r24, 0x43	; 67
+ 7c8:	9d e0       	ldi	r25, 0x0D	; 13
+ 7ca:	a0 e0       	ldi	r26, 0x00	; 0
+ 7cc:	b0 e0       	ldi	r27, 0x00	; 0
+ 7ce:	8c 83       	std	Y+4, r24	; 0x04
+ 7d0:	9d 83       	std	Y+5, r25	; 0x05
+ 7d2:	ae 83       	std	Y+6, r26	; 0x06
+ 7d4:	bf 83       	std	Y+7, r27	; 0x07
+ 7d6:	8a a3       	std	Y+34, r24	; 0x22
+ 7d8:	9b a3       	std	Y+35, r25	; 0x23
+ 7da:	ac a3       	std	Y+36, r26	; 0x24
+ 7dc:	bd a3       	std	Y+37, r27	; 0x25
 	inst->pllb_param_data.MSNx_P2 = inst->plla_param_data.MSNx_P2 = 11510;
- 790:	86 ef       	ldi	r24, 0xF6	; 246
- 792:	9c e2       	ldi	r25, 0x2C	; 44
- 794:	a0 e0       	ldi	r26, 0x00	; 0
- 796:	b0 e0       	ldi	r27, 0x00	; 0
- 798:	89 87       	std	Y+9, r24	; 0x09
- 79a:	9a 87       	std	Y+10, r25	; 0x0a
- 79c:	ab 87       	std	Y+11, r26	; 0x0b
- 79e:	bc 87       	std	Y+12, r27	; 0x0c
- 7a0:	8f a3       	std	Y+39, r24	; 0x27
- 7a2:	98 a7       	std	Y+40, r25	; 0x28
- 7a4:	a9 a7       	std	Y+41, r26	; 0x29
- 7a6:	ba a7       	std	Y+42, r27	; 0x2a
+ 7de:	86 ef       	ldi	r24, 0xF6	; 246
+ 7e0:	9c e2       	ldi	r25, 0x2C	; 44
+ 7e2:	a0 e0       	ldi	r26, 0x00	; 0
+ 7e4:	b0 e0       	ldi	r27, 0x00	; 0
+ 7e6:	88 87       	std	Y+8, r24	; 0x08
+ 7e8:	99 87       	std	Y+9, r25	; 0x09
+ 7ea:	aa 87       	std	Y+10, r26	; 0x0a
+ 7ec:	bb 87       	std	Y+11, r27	; 0x0b
+ 7ee:	8e a3       	std	Y+38, r24	; 0x26
+ 7f0:	9f a3       	std	Y+39, r25	; 0x27
+ 7f2:	a8 a7       	std	Y+40, r26	; 0x28
+ 7f4:	b9 a7       	std	Y+41, r27	; 0x29
 	inst->pllb_param_data.MSNx_P3 = inst->plla_param_data.MSNx_P3 = 1067099;
- 7a8:	8b e5       	ldi	r24, 0x5B	; 91
- 7aa:	98 e4       	ldi	r25, 0x48	; 72
- 7ac:	a0 e1       	ldi	r26, 0x10	; 16
- 7ae:	b0 e0       	ldi	r27, 0x00	; 0
- 7b0:	8d 87       	std	Y+13, r24	; 0x0d
- 7b2:	9e 87       	std	Y+14, r25	; 0x0e
- 7b4:	af 87       	std	Y+15, r26	; 0x0f
- 7b6:	b8 8b       	std	Y+16, r27	; 0x10
- 7b8:	8b a7       	std	Y+43, r24	; 0x2b
- 7ba:	9c a7       	std	Y+44, r25	; 0x2c
- 7bc:	ad a7       	std	Y+45, r26	; 0x2d
- 7be:	be a7       	std	Y+46, r27	; 0x2e
+ 7f6:	8b e5       	ldi	r24, 0x5B	; 91
+ 7f8:	98 e4       	ldi	r25, 0x48	; 72
+ 7fa:	a0 e1       	ldi	r26, 0x10	; 16
+ 7fc:	b0 e0       	ldi	r27, 0x00	; 0
+ 7fe:	8c 87       	std	Y+12, r24	; 0x0c
+ 800:	9d 87       	std	Y+13, r25	; 0x0d
+ 802:	ae 87       	std	Y+14, r26	; 0x0e
+ 804:	bf 87       	std	Y+15, r27	; 0x0f
+ 806:	8a a7       	std	Y+42, r24	; 0x2a
+ 808:	9b a7       	std	Y+43, r25	; 0x2b
+ 80a:	ac a7       	std	Y+44, r26	; 0x2c
+ 80c:	bd a7       	std	Y+45, r27	; 0x2d
 			
 	inst->pllb_param_data.MSx_P1 = inst->plla_param_data.MSx_P1 = 18;
- 7c0:	82 e1       	ldi	r24, 0x12	; 18
- 7c2:	90 e0       	ldi	r25, 0x00	; 0
- 7c4:	a0 e0       	ldi	r26, 0x00	; 0
- 7c6:	b0 e0       	ldi	r27, 0x00	; 0
- 7c8:	89 8b       	std	Y+17, r24	; 0x11
- 7ca:	9a 8b       	std	Y+18, r25	; 0x12
- 7cc:	ab 8b       	std	Y+19, r26	; 0x13
- 7ce:	bc 8b       	std	Y+20, r27	; 0x14
- 7d0:	8f a7       	std	Y+47, r24	; 0x2f
- 7d2:	98 ab       	std	Y+48, r25	; 0x30
- 7d4:	a9 ab       	std	Y+49, r26	; 0x31
- 7d6:	ba ab       	std	Y+50, r27	; 0x32
+ 80e:	82 e1       	ldi	r24, 0x12	; 18
+ 810:	90 e0       	ldi	r25, 0x00	; 0
+ 812:	a0 e0       	ldi	r26, 0x00	; 0
+ 814:	b0 e0       	ldi	r27, 0x00	; 0
+ 816:	88 8b       	std	Y+16, r24	; 0x10
+ 818:	99 8b       	std	Y+17, r25	; 0x11
+ 81a:	aa 8b       	std	Y+18, r26	; 0x12
+ 81c:	bb 8b       	std	Y+19, r27	; 0x13
+ 81e:	8e a7       	std	Y+46, r24	; 0x2e
+ 820:	9f a7       	std	Y+47, r25	; 0x2f
+ 822:	a8 ab       	std	Y+48, r26	; 0x30
+ 824:	b9 ab       	std	Y+49, r27	; 0x31
 	inst->pllb_param_data.MSx_P2 = inst->plla_param_data.MSx_P2 = 0;
- 7d8:	1d 8a       	std	Y+21, r1	; 0x15
- 7da:	1e 8a       	std	Y+22, r1	; 0x16
- 7dc:	1f 8a       	std	Y+23, r1	; 0x17
- 7de:	18 8e       	std	Y+24, r1	; 0x18
- 7e0:	1b aa       	std	Y+51, r1	; 0x33
- 7e2:	1c aa       	std	Y+52, r1	; 0x34
- 7e4:	1d aa       	std	Y+53, r1	; 0x35
- 7e6:	1e aa       	std	Y+54, r1	; 0x36
+ 826:	1c 8a       	std	Y+20, r1	; 0x14
+ 828:	1d 8a       	std	Y+21, r1	; 0x15
+ 82a:	1e 8a       	std	Y+22, r1	; 0x16
+ 82c:	1f 8a       	std	Y+23, r1	; 0x17
+ 82e:	1a aa       	std	Y+50, r1	; 0x32
+ 830:	1b aa       	std	Y+51, r1	; 0x33
+ 832:	1c aa       	std	Y+52, r1	; 0x34
+ 834:	1d aa       	std	Y+53, r1	; 0x35
 	inst->pllb_param_data.MSx_P3 = inst->plla_param_data.MSx_P3 = 1;
- 7e8:	81 e0       	ldi	r24, 0x01	; 1
- 7ea:	90 e0       	ldi	r25, 0x00	; 0
- 7ec:	a0 e0       	ldi	r26, 0x00	; 0
- 7ee:	b0 e0       	ldi	r27, 0x00	; 0
- 7f0:	89 8f       	std	Y+25, r24	; 0x19
- 7f2:	9a 8f       	std	Y+26, r25	; 0x1a
- 7f4:	ab 8f       	std	Y+27, r26	; 0x1b
- 7f6:	bc 8f       	std	Y+28, r27	; 0x1c
- 7f8:	8f ab       	std	Y+55, r24	; 0x37
- 7fa:	98 af       	std	Y+56, r25	; 0x38
- 7fc:	a9 af       	std	Y+57, r26	; 0x39
- 7fe:	ba af       	std	Y+58, r27	; 0x3a
+ 836:	81 e0       	ldi	r24, 0x01	; 1
+ 838:	90 e0       	ldi	r25, 0x00	; 0
+ 83a:	a0 e0       	ldi	r26, 0x00	; 0
+ 83c:	b0 e0       	ldi	r27, 0x00	; 0
+ 83e:	88 8f       	std	Y+24, r24	; 0x18
+ 840:	99 8f       	std	Y+25, r25	; 0x19
+ 842:	aa 8f       	std	Y+26, r26	; 0x1a
+ 844:	bb 8f       	std	Y+27, r27	; 0x1b
+ 846:	8e ab       	std	Y+54, r24	; 0x36
+ 848:	9f ab       	std	Y+55, r25	; 0x37
+ 84a:	a8 af       	std	Y+56, r26	; 0x38
+ 84c:	b9 af       	std	Y+57, r27	; 0x39
 	inst->pllb_param_data.XtalFreq = inst->plla_param_data.XtalFreq = 25000000;
- 800:	80 e4       	ldi	r24, 0x40	; 64
- 802:	98 e7       	ldi	r25, 0x78	; 120
- 804:	ad e7       	ldi	r26, 0x7D	; 125
- 806:	b1 e0       	ldi	r27, 0x01	; 1
- 808:	8e 8f       	std	Y+30, r24	; 0x1e
- 80a:	9f 8f       	std	Y+31, r25	; 0x1f
- 80c:	a8 a3       	std	Y+32, r26	; 0x20
- 80e:	b9 a3       	std	Y+33, r27	; 0x21
- 810:	8c af       	std	Y+60, r24	; 0x3c
- 812:	9d af       	std	Y+61, r25	; 0x3d
- 814:	ae af       	std	Y+62, r26	; 0x3e
- 816:	bf af       	std	Y+63, r27	; 0x3f
+ 84e:	80 e4       	ldi	r24, 0x40	; 64
+ 850:	98 e7       	ldi	r25, 0x78	; 120
+ 852:	ad e7       	ldi	r26, 0x7D	; 125
+ 854:	b1 e0       	ldi	r27, 0x01	; 1
+ 856:	8d 8f       	std	Y+29, r24	; 0x1d
+ 858:	9e 8f       	std	Y+30, r25	; 0x1e
+ 85a:	af 8f       	std	Y+31, r26	; 0x1f
+ 85c:	b8 a3       	std	Y+32, r27	; 0x20
+ 85e:	8b af       	std	Y+59, r24	; 0x3b
+ 860:	9c af       	std	Y+60, r25	; 0x3c
+ 862:	ad af       	std	Y+61, r26	; 0x3d
+ 864:	be af       	std	Y+62, r27	; 0x3e
 	
 	cm_EEPROM_write((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t*)&(inst->plla_param_data), sizeof(storno_pll_param_msg));
- 818:	be 01       	movw	r22, r28
- 81a:	6c 5f       	subi	r22, 0xFC	; 252
- 81c:	7f 4f       	sbci	r23, 0xFF	; 255
- 81e:	4e e1       	ldi	r20, 0x1E	; 30
- 820:	80 e0       	ldi	r24, 0x00	; 0
- 822:	90 e0       	ldi	r25, 0x00	; 0
- 824:	23 dc       	rcall	.-1978   	; 0x6c <cm_EEPROM_write>
+ 866:	4e e1       	ldi	r20, 0x1E	; 30
+ 868:	be 01       	movw	r22, r28
+ 86a:	6d 5f       	subi	r22, 0xFD	; 253
+ 86c:	7f 4f       	sbci	r23, 0xFF	; 255
+ 86e:	80 e0       	ldi	r24, 0x00	; 0
+ 870:	90 e0       	ldi	r25, 0x00	; 0
+ 872:	fc db       	rcall	.-2056   	; 0x6c <cm_EEPROM_write>
 	//_delay_ms(1);
 	cm_EEPROM_write((uint8_t*)PLLB_SETTINGS_EEPROM_ADDR,(uint8_t*)&(inst->pllb_param_data), sizeof(storno_pll_param_msg));
- 826:	4e e1       	ldi	r20, 0x1E	; 30
- 828:	b8 01       	movw	r22, r16
- 82a:	80 e2       	ldi	r24, 0x20	; 32
- 82c:	90 e0       	ldi	r25, 0x00	; 0
- 82e:	1e dc       	rcall	.-1988   	; 0x6c <cm_EEPROM_write>
- 830:	06 c0       	rjmp	.+12     	; 0x83e <cqm6xx_app_init+0x120>
+ 874:	4e e1       	ldi	r20, 0x1E	; 30
+ 876:	b8 01       	movw	r22, r16
+ 878:	80 e2       	ldi	r24, 0x20	; 32
+ 87a:	90 e0       	ldi	r25, 0x00	; 0
+ 87c:	f7 db       	rcall	.-2066   	; 0x6c <cm_EEPROM_write>
+ 87e:	a0 cf       	rjmp	.-192    	; 0x7c0 <cqm6xx_app_init+0x56>
 	{
 		if ((*ptr != 0xff) && (*ptr != 0x00))
 		{
 			return 1;
 		}
 		ptr++;
- 832:	fe 01       	movw	r30, r28
- 834:	b3 96       	adiw	r30, 0x23	; 35
- 836:	9e 01       	movw	r18, r28
- 838:	20 5c       	subi	r18, 0xC0	; 192
- 83a:	3f 4f       	sbci	r19, 0xFF	; 255
- 83c:	95 cf       	rjmp	.-214    	; 0x768 <cqm6xx_app_init+0x4a>
-	if(!isEEPROMValid(inst)){
-		// If settings are somehow unvalid, then write default settings..
+ 880:	fe 01       	movw	r30, r28
+ 882:	b2 96       	adiw	r30, 0x22	; 34
+ 884:	9e 01       	movw	r18, r28
+ 886:	21 5c       	subi	r18, 0xC1	; 193
+ 888:	3f 4f       	sbci	r19, 0xFF	; 255
+ 88a:	92 cf       	rjmp	.-220    	; 0x7b0 <cqm6xx_app_init+0x46>
 		writeDefaultSettingsEEprom(inst);
 	}
 	
- 83e:	df 91       	pop	r29
- 840:	cf 91       	pop	r28
- 842:	1f 91       	pop	r17
- 844:	0f 91       	pop	r16
- 846:	08 95       	ret
+	cqm6xx_app_loadPLLParam(inst);
+	
+ 88c:	df 91       	pop	r29
+ 88e:	cf 91       	pop	r28
+ 890:	1f 91       	pop	r17
+ 892:	0f 91       	pop	r16
+ 894:	08 95       	ret
+
+00000896 <main>:
 
-00000848 <main>:
-#include "avr_eeprom_driver/avr_eeprom_driver.h"
 
 storno_xtal_app_t storno_xtal_app;
 		
 int main(void)
 {
- 848:	cf 93       	push	r28
- 84a:	df 93       	push	r29
- 84c:	cd b7       	in	r28, 0x3d	; 61
- 84e:	de b7       	in	r29, 0x3e	; 62
- 850:	a2 97       	sbiw	r28, 0x22	; 34
- 852:	cd bf       	out	0x3d, r28	; 61
- 854:	de bf       	out	0x3e, r29	; 62
+ 896:	cf 93       	push	r28
+ 898:	df 93       	push	r29
+ 89a:	cd b7       	in	r28, 0x3d	; 61
+ 89c:	de b7       	in	r29, 0x3e	; 62
+ 89e:	a2 97       	sbiw	r28, 0x22	; 34
+ 8a0:	cd bf       	out	0x3d, r28	; 61
+ 8a2:	de bf       	out	0x3e, r29	; 62
     /* Replace with your application code */
 
 		// Init Periphials
 		cm_i2c_init(NULL);
- 856:	80 e0       	ldi	r24, 0x00	; 0
- 858:	90 e0       	ldi	r25, 0x00	; 0
- 85a:	2b dd       	rcall	.-1450   	; 0x2b2 <cm_i2c_init>
+ 8a4:	80 e0       	ldi	r24, 0x00	; 0
+ 8a6:	90 e0       	ldi	r25, 0x00	; 0
+ 8a8:	04 dd       	rcall	.-1528   	; 0x2b2 <cm_i2c_init>
 		
 		// Add devices
 		cm_i2c_device_t si5351_i2c;
 		cm_i2c_addDev(&si5351_i2c,NULL,0x60);
- 85c:	40 e6       	ldi	r20, 0x60	; 96
- 85e:	60 e0       	ldi	r22, 0x00	; 0
- 860:	70 e0       	ldi	r23, 0x00	; 0
- 862:	ce 01       	movw	r24, r28
- 864:	01 96       	adiw	r24, 0x01	; 1
- 866:	3f dd       	rcall	.-1410   	; 0x2e6 <cm_i2c_addDev>
+ 8aa:	40 e6       	ldi	r20, 0x60	; 96
+ 8ac:	60 e0       	ldi	r22, 0x00	; 0
+ 8ae:	70 e0       	ldi	r23, 0x00	; 0
+ 8b0:	ce 01       	movw	r24, r28
+ 8b2:	01 96       	adiw	r24, 0x01	; 1
+ 8b4:	18 dd       	rcall	.-1488   	; 0x2e6 <cm_i2c_addDev>
 		
 		// Init Devices:
 		si5351_driver si5351_dev;
 		cm_si5351_init(&si5351_dev,&si5351_i2c,(setGet_I2C_Event_fpt)cm_i2c_transfer);		
- 868:	41 e9       	ldi	r20, 0x91	; 145
- 86a:	51 e0       	ldi	r21, 0x01	; 1
- 86c:	be 01       	movw	r22, r28
- 86e:	6f 5f       	subi	r22, 0xFF	; 255
- 870:	7f 4f       	sbci	r23, 0xFF	; 255
- 872:	ce 01       	movw	r24, r28
- 874:	04 96       	adiw	r24, 0x04	; 4
- 876:	82 d1       	rcall	.+772    	; 0xb7c <cm_si5351_init>
+ 8b6:	41 e9       	ldi	r20, 0x91	; 145
+ 8b8:	51 e0       	ldi	r21, 0x01	; 1
+ 8ba:	be 01       	movw	r22, r28
+ 8bc:	6f 5f       	subi	r22, 0xFF	; 255
+ 8be:	7f 4f       	sbci	r23, 0xFF	; 255
+ 8c0:	ce 01       	movw	r24, r28
+ 8c2:	04 96       	adiw	r24, 0x04	; 4
+ 8c4:	82 d1       	rcall	.+772    	; 0xbca <cm_si5351_init>
 		cqm6xx_app_init(&storno_xtal_app, &si5351_dev);
- 878:	be 01       	movw	r22, r28
- 87a:	6c 5f       	subi	r22, 0xFC	; 252
- 87c:	7f 4f       	sbci	r23, 0xFF	; 255
- 87e:	86 e4       	ldi	r24, 0x46	; 70
- 880:	9f e3       	ldi	r25, 0x3F	; 63
- 882:	4d df       	rcall	.-358    	; 0x71e <cqm6xx_app_init>
+ 8c6:	be 01       	movw	r22, r28
+ 8c8:	6c 5f       	subi	r22, 0xFC	; 252
+ 8ca:	7f 4f       	sbci	r23, 0xFF	; 255
+ 8cc:	86 e4       	ldi	r24, 0x46	; 70
+ 8ce:	9f e3       	ldi	r25, 0x3F	; 63
+ 8d0:	4c df       	rcall	.-360    	; 0x76a <cqm6xx_app_init>
+		
 
     while (1) 
     {
 
-		cqm6xx_app_statemachine(&storno_xtal_app);
- 884:	86 e4       	ldi	r24, 0x46	; 70
- 886:	9f e3       	ldi	r25, 0x3F	; 63
- 888:	ee de       	rcall	.-548    	; 0x666 <cqm6xx_app_statemachine>
- 88a:	fc cf       	rjmp	.-8      	; 0x884 <main+0x3c>
+		cqm6xx_app_taskHandler(&storno_xtal_app);
+ 8d2:	86 e4       	ldi	r24, 0x46	; 70
+ 8d4:	9f e3       	ldi	r25, 0x3F	; 63
+ 8d6:	20 df       	rcall	.-448    	; 0x718 <cqm6xx_app_taskHandler>
+ 8d8:	fc cf       	rjmp	.-8      	; 0x8d2 <main+0x3c>
 
-0000088c <writeRegister>:
+000008da <writeRegister>:
 
 	// Read Device Status register:
 	readRegister(inst,0x00, (uint8_t *) &inst->device_data.deviceStatus, sizeof(si5351_deviceStat_t));
 
 	return inst->device_data.deviceStatus.REVID;
 }
- 88c:	8f 92       	push	r8
- 88e:	9f 92       	push	r9
- 890:	af 92       	push	r10
- 892:	bf 92       	push	r11
- 894:	cf 92       	push	r12
- 896:	df 92       	push	r13
- 898:	ef 92       	push	r14
- 89a:	ff 92       	push	r15
- 89c:	0f 93       	push	r16
- 89e:	1f 93       	push	r17
- 8a0:	cf 93       	push	r28
- 8a2:	df 93       	push	r29
- 8a4:	ec 01       	movw	r28, r24
- 8a6:	86 2e       	mov	r8, r22
- 8a8:	5a 01       	movw	r10, r20
- 8aa:	68 01       	movw	r12, r16
- 8ac:	79 01       	movw	r14, r18
- 8ae:	c8 01       	movw	r24, r16
- 8b0:	01 96       	adiw	r24, 0x01	; 1
- 8b2:	11 d2       	rcall	.+1058   	; 0xcd6 <malloc>
- 8b4:	98 2e       	mov	r9, r24
- 8b6:	19 2f       	mov	r17, r25
- 8b8:	fc 01       	movw	r30, r24
- 8ba:	81 92       	st	Z+, r8
- 8bc:	cf 01       	movw	r24, r30
- 8be:	a6 01       	movw	r20, r12
- 8c0:	b5 01       	movw	r22, r10
- 8c2:	2a d3       	rcall	.+1620   	; 0xf18 <memcpy>
- 8c4:	a7 01       	movw	r20, r14
- 8c6:	96 01       	movw	r18, r12
- 8c8:	2f 5f       	subi	r18, 0xFF	; 255
- 8ca:	3f 4f       	sbci	r19, 0xFF	; 255
- 8cc:	4f 4f       	sbci	r20, 0xFF	; 255
- 8ce:	5f 4f       	sbci	r21, 0xFF	; 255
- 8d0:	ea 81       	ldd	r30, Y+2	; 0x02
- 8d2:	fb 81       	ldd	r31, Y+3	; 0x03
- 8d4:	01 e0       	ldi	r16, 0x01	; 1
- 8d6:	69 2d       	mov	r22, r9
- 8d8:	71 2f       	mov	r23, r17
- 8da:	88 81       	ld	r24, Y
- 8dc:	99 81       	ldd	r25, Y+1	; 0x01
- 8de:	09 95       	icall
- 8e0:	89 2d       	mov	r24, r9
- 8e2:	91 2f       	mov	r25, r17
- 8e4:	90 d2       	rcall	.+1312   	; 0xe06 <free>
- 8e6:	80 e0       	ldi	r24, 0x00	; 0
- 8e8:	90 e0       	ldi	r25, 0x00	; 0
- 8ea:	df 91       	pop	r29
- 8ec:	cf 91       	pop	r28
- 8ee:	1f 91       	pop	r17
- 8f0:	0f 91       	pop	r16
- 8f2:	ff 90       	pop	r15
- 8f4:	ef 90       	pop	r14
- 8f6:	df 90       	pop	r13
- 8f8:	cf 90       	pop	r12
- 8fa:	bf 90       	pop	r11
- 8fc:	af 90       	pop	r10
- 8fe:	9f 90       	pop	r9
- 900:	8f 90       	pop	r8
- 902:	08 95       	ret
+ 8da:	8f 92       	push	r8
+ 8dc:	9f 92       	push	r9
+ 8de:	af 92       	push	r10
+ 8e0:	bf 92       	push	r11
+ 8e2:	cf 92       	push	r12
+ 8e4:	df 92       	push	r13
+ 8e6:	ef 92       	push	r14
+ 8e8:	ff 92       	push	r15
+ 8ea:	0f 93       	push	r16
+ 8ec:	1f 93       	push	r17
+ 8ee:	cf 93       	push	r28
+ 8f0:	df 93       	push	r29
+ 8f2:	ec 01       	movw	r28, r24
+ 8f4:	86 2e       	mov	r8, r22
+ 8f6:	5a 01       	movw	r10, r20
+ 8f8:	68 01       	movw	r12, r16
+ 8fa:	79 01       	movw	r14, r18
+ 8fc:	c8 01       	movw	r24, r16
+ 8fe:	01 96       	adiw	r24, 0x01	; 1
+ 900:	11 d2       	rcall	.+1058   	; 0xd24 <malloc>
+ 902:	98 2e       	mov	r9, r24
+ 904:	19 2f       	mov	r17, r25
+ 906:	fc 01       	movw	r30, r24
+ 908:	81 92       	st	Z+, r8
+ 90a:	cf 01       	movw	r24, r30
+ 90c:	a6 01       	movw	r20, r12
+ 90e:	b5 01       	movw	r22, r10
+ 910:	2a d3       	rcall	.+1620   	; 0xf66 <memcpy>
+ 912:	a7 01       	movw	r20, r14
+ 914:	96 01       	movw	r18, r12
+ 916:	2f 5f       	subi	r18, 0xFF	; 255
+ 918:	3f 4f       	sbci	r19, 0xFF	; 255
+ 91a:	4f 4f       	sbci	r20, 0xFF	; 255
+ 91c:	5f 4f       	sbci	r21, 0xFF	; 255
+ 91e:	ea 81       	ldd	r30, Y+2	; 0x02
+ 920:	fb 81       	ldd	r31, Y+3	; 0x03
+ 922:	01 e0       	ldi	r16, 0x01	; 1
+ 924:	69 2d       	mov	r22, r9
+ 926:	71 2f       	mov	r23, r17
+ 928:	88 81       	ld	r24, Y
+ 92a:	99 81       	ldd	r25, Y+1	; 0x01
+ 92c:	09 95       	icall
+ 92e:	89 2d       	mov	r24, r9
+ 930:	91 2f       	mov	r25, r17
+ 932:	90 d2       	rcall	.+1312   	; 0xe54 <free>
+ 934:	80 e0       	ldi	r24, 0x00	; 0
+ 936:	90 e0       	ldi	r25, 0x00	; 0
+ 938:	df 91       	pop	r29
+ 93a:	cf 91       	pop	r28
+ 93c:	1f 91       	pop	r17
+ 93e:	0f 91       	pop	r16
+ 940:	ff 90       	pop	r15
+ 942:	ef 90       	pop	r14
+ 944:	df 90       	pop	r13
+ 946:	cf 90       	pop	r12
+ 948:	bf 90       	pop	r11
+ 94a:	af 90       	pop	r10
+ 94c:	9f 90       	pop	r9
+ 94e:	8f 90       	pop	r8
+ 950:	08 95       	ret
 
-00000904 <cm_setOutputMultiSynthRaw>:
- 904:	af 92       	push	r10
- 906:	bf 92       	push	r11
- 908:	cf 92       	push	r12
- 90a:	df 92       	push	r13
- 90c:	ef 92       	push	r14
- 90e:	ff 92       	push	r15
- 910:	0f 93       	push	r16
- 912:	1f 93       	push	r17
- 914:	fc 01       	movw	r30, r24
- 916:	43 70       	andi	r20, 0x03	; 3
- 918:	56 89       	ldd	r21, Z+22	; 0x16
- 91a:	50 78       	andi	r21, 0x80	; 128
- 91c:	37 8b       	std	Z+23, r19	; 0x17
- 91e:	20 8f       	std	Z+24, r18	; 0x18
- 920:	f2 8e       	std	Z+26, r15	; 0x1a
- 922:	e3 8e       	std	Z+27, r14	; 0x1b
- 924:	d6 01       	movw	r26, r12
- 926:	c5 01       	movw	r24, r10
- 928:	07 2e       	mov	r0, r23
- 92a:	7c e0       	ldi	r23, 0x0C	; 12
- 92c:	b6 95       	lsr	r27
- 92e:	a7 95       	ror	r26
- 930:	97 95       	ror	r25
- 932:	87 95       	ror	r24
- 934:	7a 95       	dec	r23
- 936:	d1 f7       	brne	.-12     	; 0x92c <cm_setOutputMultiSynthRaw+0x28>
- 938:	70 2d       	mov	r23, r0
- 93a:	83 70       	andi	r24, 0x03	; 3
- 93c:	82 95       	swap	r24
- 93e:	80 7f       	andi	r24, 0xF0	; 240
- 940:	03 70       	andi	r16, 0x03	; 3
- 942:	80 2b       	or	r24, r16
- 944:	81 8f       	std	Z+25, r24	; 0x19
- 946:	b4 8a       	std	Z+20, r11	; 0x14
- 948:	a5 8a       	std	Z+21, r10	; 0x15
- 94a:	45 2b       	or	r20, r21
- 94c:	46 8b       	std	Z+22, r20	; 0x16
- 94e:	61 30       	cpi	r22, 0x01	; 1
- 950:	79 f0       	breq	.+30     	; 0x970 <cm_setOutputMultiSynthRaw+0x6c>
- 952:	18 f0       	brcs	.+6      	; 0x95a <cm_setOutputMultiSynthRaw+0x56>
- 954:	62 30       	cpi	r22, 0x02	; 2
- 956:	b9 f0       	breq	.+46     	; 0x986 <cm_setOutputMultiSynthRaw+0x82>
- 958:	20 c0       	rjmp	.+64     	; 0x99a <cm_setOutputMultiSynthRaw+0x96>
- 95a:	af 01       	movw	r20, r30
- 95c:	4c 5e       	subi	r20, 0xEC	; 236
- 95e:	5f 4f       	sbci	r21, 0xFF	; 255
- 960:	08 e0       	ldi	r16, 0x08	; 8
- 962:	10 e0       	ldi	r17, 0x00	; 0
- 964:	20 e0       	ldi	r18, 0x00	; 0
- 966:	30 e0       	ldi	r19, 0x00	; 0
- 968:	6a e2       	ldi	r22, 0x2A	; 42
- 96a:	cf 01       	movw	r24, r30
- 96c:	8f df       	rcall	.-226    	; 0x88c <writeRegister>
- 96e:	15 c0       	rjmp	.+42     	; 0x99a <cm_setOutputMultiSynthRaw+0x96>
- 970:	af 01       	movw	r20, r30
- 972:	4c 5e       	subi	r20, 0xEC	; 236
- 974:	5f 4f       	sbci	r21, 0xFF	; 255
- 976:	08 e0       	ldi	r16, 0x08	; 8
- 978:	10 e0       	ldi	r17, 0x00	; 0
- 97a:	20 e0       	ldi	r18, 0x00	; 0
- 97c:	30 e0       	ldi	r19, 0x00	; 0
- 97e:	62 e3       	ldi	r22, 0x32	; 50
- 980:	cf 01       	movw	r24, r30
- 982:	84 df       	rcall	.-248    	; 0x88c <writeRegister>
- 984:	0a c0       	rjmp	.+20     	; 0x99a <cm_setOutputMultiSynthRaw+0x96>
- 986:	af 01       	movw	r20, r30
- 988:	4c 5e       	subi	r20, 0xEC	; 236
- 98a:	5f 4f       	sbci	r21, 0xFF	; 255
- 98c:	08 e0       	ldi	r16, 0x08	; 8
- 98e:	10 e0       	ldi	r17, 0x00	; 0
- 990:	20 e0       	ldi	r18, 0x00	; 0
- 992:	30 e0       	ldi	r19, 0x00	; 0
- 994:	6a e3       	ldi	r22, 0x3A	; 58
- 996:	cf 01       	movw	r24, r30
- 998:	79 df       	rcall	.-270    	; 0x88c <writeRegister>
- 99a:	80 e0       	ldi	r24, 0x00	; 0
- 99c:	90 e0       	ldi	r25, 0x00	; 0
- 99e:	1f 91       	pop	r17
- 9a0:	0f 91       	pop	r16
- 9a2:	ff 90       	pop	r15
- 9a4:	ef 90       	pop	r14
- 9a6:	df 90       	pop	r13
- 9a8:	cf 90       	pop	r12
- 9aa:	bf 90       	pop	r11
- 9ac:	af 90       	pop	r10
- 9ae:	08 95       	ret
-
-000009b0 <cm_setOutputEnable>:
- 9b0:	0f 93       	push	r16
- 9b2:	1f 93       	push	r17
- 9b4:	61 30       	cpi	r22, 0x01	; 1
- 9b6:	51 f0       	breq	.+20     	; 0x9cc <cm_setOutputEnable+0x1c>
- 9b8:	18 f0       	brcs	.+6      	; 0x9c0 <cm_setOutputEnable+0x10>
- 9ba:	62 30       	cpi	r22, 0x02	; 2
- 9bc:	69 f0       	breq	.+26     	; 0x9d8 <cm_setOutputEnable+0x28>
- 9be:	11 c0       	rjmp	.+34     	; 0x9e2 <cm_setOutputEnable+0x32>
- 9c0:	fc 01       	movw	r30, r24
- 9c2:	27 81       	ldd	r18, Z+7	; 0x07
- 9c4:	40 fb       	bst	r20, 0
- 9c6:	20 f9       	bld	r18, 0
- 9c8:	27 83       	std	Z+7, r18	; 0x07
- 9ca:	0b c0       	rjmp	.+22     	; 0x9e2 <cm_setOutputEnable+0x32>
- 9cc:	fc 01       	movw	r30, r24
- 9ce:	27 81       	ldd	r18, Z+7	; 0x07
- 9d0:	40 fb       	bst	r20, 0
- 9d2:	21 f9       	bld	r18, 1
- 9d4:	27 83       	std	Z+7, r18	; 0x07
- 9d6:	05 c0       	rjmp	.+10     	; 0x9e2 <cm_setOutputEnable+0x32>
- 9d8:	fc 01       	movw	r30, r24
- 9da:	27 81       	ldd	r18, Z+7	; 0x07
- 9dc:	40 fb       	bst	r20, 0
- 9de:	22 f9       	bld	r18, 2
- 9e0:	27 83       	std	Z+7, r18	; 0x07
- 9e2:	ac 01       	movw	r20, r24
- 9e4:	49 5f       	subi	r20, 0xF9	; 249
- 9e6:	5f 4f       	sbci	r21, 0xFF	; 255
- 9e8:	01 e0       	ldi	r16, 0x01	; 1
- 9ea:	10 e0       	ldi	r17, 0x00	; 0
- 9ec:	20 e0       	ldi	r18, 0x00	; 0
- 9ee:	30 e0       	ldi	r19, 0x00	; 0
- 9f0:	63 e0       	ldi	r22, 0x03	; 3
- 9f2:	4c df       	rcall	.-360    	; 0x88c <writeRegister>
- 9f4:	80 e0       	ldi	r24, 0x00	; 0
- 9f6:	90 e0       	ldi	r25, 0x00	; 0
- 9f8:	1f 91       	pop	r17
- 9fa:	0f 91       	pop	r16
+00000952 <cm_setOutputMultiSynthRaw>:
+ 952:	af 92       	push	r10
+ 954:	bf 92       	push	r11
+ 956:	cf 92       	push	r12
+ 958:	df 92       	push	r13
+ 95a:	ef 92       	push	r14
+ 95c:	ff 92       	push	r15
+ 95e:	0f 93       	push	r16
+ 960:	1f 93       	push	r17
+ 962:	fc 01       	movw	r30, r24
+ 964:	43 70       	andi	r20, 0x03	; 3
+ 966:	56 89       	ldd	r21, Z+22	; 0x16
+ 968:	50 78       	andi	r21, 0x80	; 128
+ 96a:	37 8b       	std	Z+23, r19	; 0x17
+ 96c:	20 8f       	std	Z+24, r18	; 0x18
+ 96e:	f2 8e       	std	Z+26, r15	; 0x1a
+ 970:	e3 8e       	std	Z+27, r14	; 0x1b
+ 972:	d6 01       	movw	r26, r12
+ 974:	c5 01       	movw	r24, r10
+ 976:	07 2e       	mov	r0, r23
+ 978:	7c e0       	ldi	r23, 0x0C	; 12
+ 97a:	b6 95       	lsr	r27
+ 97c:	a7 95       	ror	r26
+ 97e:	97 95       	ror	r25
+ 980:	87 95       	ror	r24
+ 982:	7a 95       	dec	r23
+ 984:	d1 f7       	brne	.-12     	; 0x97a <cm_setOutputMultiSynthRaw+0x28>
+ 986:	70 2d       	mov	r23, r0
+ 988:	83 70       	andi	r24, 0x03	; 3
+ 98a:	82 95       	swap	r24
+ 98c:	80 7f       	andi	r24, 0xF0	; 240
+ 98e:	03 70       	andi	r16, 0x03	; 3
+ 990:	80 2b       	or	r24, r16
+ 992:	81 8f       	std	Z+25, r24	; 0x19
+ 994:	b4 8a       	std	Z+20, r11	; 0x14
+ 996:	a5 8a       	std	Z+21, r10	; 0x15
+ 998:	45 2b       	or	r20, r21
+ 99a:	46 8b       	std	Z+22, r20	; 0x16
+ 99c:	61 30       	cpi	r22, 0x01	; 1
+ 99e:	79 f0       	breq	.+30     	; 0x9be <cm_setOutputMultiSynthRaw+0x6c>
+ 9a0:	18 f0       	brcs	.+6      	; 0x9a8 <cm_setOutputMultiSynthRaw+0x56>
+ 9a2:	62 30       	cpi	r22, 0x02	; 2
+ 9a4:	b9 f0       	breq	.+46     	; 0x9d4 <cm_setOutputMultiSynthRaw+0x82>
+ 9a6:	20 c0       	rjmp	.+64     	; 0x9e8 <cm_setOutputMultiSynthRaw+0x96>
+ 9a8:	af 01       	movw	r20, r30
+ 9aa:	4c 5e       	subi	r20, 0xEC	; 236
+ 9ac:	5f 4f       	sbci	r21, 0xFF	; 255
+ 9ae:	08 e0       	ldi	r16, 0x08	; 8
+ 9b0:	10 e0       	ldi	r17, 0x00	; 0
+ 9b2:	20 e0       	ldi	r18, 0x00	; 0
+ 9b4:	30 e0       	ldi	r19, 0x00	; 0
+ 9b6:	6a e2       	ldi	r22, 0x2A	; 42
+ 9b8:	cf 01       	movw	r24, r30
+ 9ba:	8f df       	rcall	.-226    	; 0x8da <writeRegister>
+ 9bc:	15 c0       	rjmp	.+42     	; 0x9e8 <cm_setOutputMultiSynthRaw+0x96>
+ 9be:	af 01       	movw	r20, r30
+ 9c0:	4c 5e       	subi	r20, 0xEC	; 236
+ 9c2:	5f 4f       	sbci	r21, 0xFF	; 255
+ 9c4:	08 e0       	ldi	r16, 0x08	; 8
+ 9c6:	10 e0       	ldi	r17, 0x00	; 0
+ 9c8:	20 e0       	ldi	r18, 0x00	; 0
+ 9ca:	30 e0       	ldi	r19, 0x00	; 0
+ 9cc:	62 e3       	ldi	r22, 0x32	; 50
+ 9ce:	cf 01       	movw	r24, r30
+ 9d0:	84 df       	rcall	.-248    	; 0x8da <writeRegister>
+ 9d2:	0a c0       	rjmp	.+20     	; 0x9e8 <cm_setOutputMultiSynthRaw+0x96>
+ 9d4:	af 01       	movw	r20, r30
+ 9d6:	4c 5e       	subi	r20, 0xEC	; 236
+ 9d8:	5f 4f       	sbci	r21, 0xFF	; 255
+ 9da:	08 e0       	ldi	r16, 0x08	; 8
+ 9dc:	10 e0       	ldi	r17, 0x00	; 0
+ 9de:	20 e0       	ldi	r18, 0x00	; 0
+ 9e0:	30 e0       	ldi	r19, 0x00	; 0
+ 9e2:	6a e3       	ldi	r22, 0x3A	; 58
+ 9e4:	cf 01       	movw	r24, r30
+ 9e6:	79 df       	rcall	.-270    	; 0x8da <writeRegister>
+ 9e8:	80 e0       	ldi	r24, 0x00	; 0
+ 9ea:	90 e0       	ldi	r25, 0x00	; 0
+ 9ec:	1f 91       	pop	r17
+ 9ee:	0f 91       	pop	r16
+ 9f0:	ff 90       	pop	r15
+ 9f2:	ef 90       	pop	r14
+ 9f4:	df 90       	pop	r13
+ 9f6:	cf 90       	pop	r12
+ 9f8:	bf 90       	pop	r11
+ 9fa:	af 90       	pop	r10
  9fc:	08 95       	ret
 
-000009fe <cm_setCLKControl>:
+000009fe <cm_setOutputEnable>:
  9fe:	0f 93       	push	r16
  a00:	1f 93       	push	r17
- a02:	fc 01       	movw	r30, r24
- a04:	92 85       	ldd	r25, Z+10	; 0x0a
- a06:	40 fb       	bst	r20, 0
- a08:	97 f9       	bld	r25, 7
- a0a:	90 79       	andi	r25, 0x90	; 144
- a0c:	9f 64       	ori	r25, 0x4F	; 79
- a0e:	92 87       	std	Z+10, r25	; 0x0a
- a10:	61 30       	cpi	r22, 0x01	; 1
- a12:	79 f0       	breq	.+30     	; 0xa32 <cm_setCLKControl+0x34>
- a14:	18 f0       	brcs	.+6      	; 0xa1c <cm_setCLKControl+0x1e>
- a16:	62 30       	cpi	r22, 0x02	; 2
- a18:	b9 f0       	breq	.+46     	; 0xa48 <cm_setCLKControl+0x4a>
- a1a:	20 c0       	rjmp	.+64     	; 0xa5c <cm_setCLKControl+0x5e>
- a1c:	af 01       	movw	r20, r30
- a1e:	46 5f       	subi	r20, 0xF6	; 246
- a20:	5f 4f       	sbci	r21, 0xFF	; 255
- a22:	01 e0       	ldi	r16, 0x01	; 1
- a24:	10 e0       	ldi	r17, 0x00	; 0
- a26:	20 e0       	ldi	r18, 0x00	; 0
- a28:	30 e0       	ldi	r19, 0x00	; 0
- a2a:	60 e1       	ldi	r22, 0x10	; 16
- a2c:	cf 01       	movw	r24, r30
- a2e:	2e df       	rcall	.-420    	; 0x88c <writeRegister>
- a30:	15 c0       	rjmp	.+42     	; 0xa5c <cm_setCLKControl+0x5e>
- a32:	af 01       	movw	r20, r30
- a34:	46 5f       	subi	r20, 0xF6	; 246
- a36:	5f 4f       	sbci	r21, 0xFF	; 255
- a38:	01 e0       	ldi	r16, 0x01	; 1
- a3a:	10 e0       	ldi	r17, 0x00	; 0
- a3c:	20 e0       	ldi	r18, 0x00	; 0
- a3e:	30 e0       	ldi	r19, 0x00	; 0
- a40:	61 e1       	ldi	r22, 0x11	; 17
- a42:	cf 01       	movw	r24, r30
- a44:	23 df       	rcall	.-442    	; 0x88c <writeRegister>
- a46:	0a c0       	rjmp	.+20     	; 0xa5c <cm_setCLKControl+0x5e>
- a48:	af 01       	movw	r20, r30
- a4a:	46 5f       	subi	r20, 0xF6	; 246
- a4c:	5f 4f       	sbci	r21, 0xFF	; 255
- a4e:	01 e0       	ldi	r16, 0x01	; 1
- a50:	10 e0       	ldi	r17, 0x00	; 0
- a52:	20 e0       	ldi	r18, 0x00	; 0
- a54:	30 e0       	ldi	r19, 0x00	; 0
- a56:	62 e1       	ldi	r22, 0x12	; 18
- a58:	cf 01       	movw	r24, r30
- a5a:	18 df       	rcall	.-464    	; 0x88c <writeRegister>
- a5c:	80 e0       	ldi	r24, 0x00	; 0
- a5e:	90 e0       	ldi	r25, 0x00	; 0
- a60:	1f 91       	pop	r17
- a62:	0f 91       	pop	r16
- a64:	08 95       	ret
+ a02:	61 30       	cpi	r22, 0x01	; 1
+ a04:	51 f0       	breq	.+20     	; 0xa1a <cm_setOutputEnable+0x1c>
+ a06:	18 f0       	brcs	.+6      	; 0xa0e <cm_setOutputEnable+0x10>
+ a08:	62 30       	cpi	r22, 0x02	; 2
+ a0a:	69 f0       	breq	.+26     	; 0xa26 <cm_setOutputEnable+0x28>
+ a0c:	11 c0       	rjmp	.+34     	; 0xa30 <cm_setOutputEnable+0x32>
+ a0e:	fc 01       	movw	r30, r24
+ a10:	27 81       	ldd	r18, Z+7	; 0x07
+ a12:	40 fb       	bst	r20, 0
+ a14:	20 f9       	bld	r18, 0
+ a16:	27 83       	std	Z+7, r18	; 0x07
+ a18:	0b c0       	rjmp	.+22     	; 0xa30 <cm_setOutputEnable+0x32>
+ a1a:	fc 01       	movw	r30, r24
+ a1c:	27 81       	ldd	r18, Z+7	; 0x07
+ a1e:	40 fb       	bst	r20, 0
+ a20:	21 f9       	bld	r18, 1
+ a22:	27 83       	std	Z+7, r18	; 0x07
+ a24:	05 c0       	rjmp	.+10     	; 0xa30 <cm_setOutputEnable+0x32>
+ a26:	fc 01       	movw	r30, r24
+ a28:	27 81       	ldd	r18, Z+7	; 0x07
+ a2a:	40 fb       	bst	r20, 0
+ a2c:	22 f9       	bld	r18, 2
+ a2e:	27 83       	std	Z+7, r18	; 0x07
+ a30:	ac 01       	movw	r20, r24
+ a32:	49 5f       	subi	r20, 0xF9	; 249
+ a34:	5f 4f       	sbci	r21, 0xFF	; 255
+ a36:	01 e0       	ldi	r16, 0x01	; 1
+ a38:	10 e0       	ldi	r17, 0x00	; 0
+ a3a:	20 e0       	ldi	r18, 0x00	; 0
+ a3c:	30 e0       	ldi	r19, 0x00	; 0
+ a3e:	63 e0       	ldi	r22, 0x03	; 3
+ a40:	4c df       	rcall	.-360    	; 0x8da <writeRegister>
+ a42:	80 e0       	ldi	r24, 0x00	; 0
+ a44:	90 e0       	ldi	r25, 0x00	; 0
+ a46:	1f 91       	pop	r17
+ a48:	0f 91       	pop	r16
+ a4a:	08 95       	ret
 
-00000a66 <cm_setInputSource>:
- a66:	0f 93       	push	r16
- a68:	1f 93       	push	r17
- a6a:	66 23       	and	r22, r22
- a6c:	19 f0       	breq	.+6      	; 0xa74 <cm_setInputSource+0xe>
- a6e:	61 30       	cpi	r22, 0x01	; 1
- a70:	39 f0       	breq	.+14     	; 0xa80 <cm_setInputSource+0x1a>
- a72:	0a c0       	rjmp	.+20     	; 0xa88 <cm_setInputSource+0x22>
- a74:	fc 01       	movw	r30, r24
- a76:	21 85       	ldd	r18, Z+9	; 0x09
- a78:	2b 7f       	andi	r18, 0xFB	; 251
- a7a:	27 7f       	andi	r18, 0xF7	; 247
- a7c:	21 87       	std	Z+9, r18	; 0x09
- a7e:	04 c0       	rjmp	.+8      	; 0xa88 <cm_setInputSource+0x22>
- a80:	fc 01       	movw	r30, r24
- a82:	21 85       	ldd	r18, Z+9	; 0x09
- a84:	24 60       	ori	r18, 0x04	; 4
- a86:	21 87       	std	Z+9, r18	; 0x09
- a88:	ac 01       	movw	r20, r24
- a8a:	47 5f       	subi	r20, 0xF7	; 247
- a8c:	5f 4f       	sbci	r21, 0xFF	; 255
- a8e:	01 e0       	ldi	r16, 0x01	; 1
- a90:	10 e0       	ldi	r17, 0x00	; 0
- a92:	20 e0       	ldi	r18, 0x00	; 0
- a94:	30 e0       	ldi	r19, 0x00	; 0
- a96:	60 ef       	ldi	r22, 0xF0	; 240
- a98:	f9 de       	rcall	.-526    	; 0x88c <writeRegister>
- a9a:	80 e0       	ldi	r24, 0x00	; 0
- a9c:	90 e0       	ldi	r25, 0x00	; 0
- a9e:	1f 91       	pop	r17
- aa0:	0f 91       	pop	r16
- aa2:	08 95       	ret
+00000a4c <cm_setCLKControl>:
+ a4c:	0f 93       	push	r16
+ a4e:	1f 93       	push	r17
+ a50:	fc 01       	movw	r30, r24
+ a52:	92 85       	ldd	r25, Z+10	; 0x0a
+ a54:	40 fb       	bst	r20, 0
+ a56:	97 f9       	bld	r25, 7
+ a58:	90 79       	andi	r25, 0x90	; 144
+ a5a:	9f 64       	ori	r25, 0x4F	; 79
+ a5c:	92 87       	std	Z+10, r25	; 0x0a
+ a5e:	61 30       	cpi	r22, 0x01	; 1
+ a60:	79 f0       	breq	.+30     	; 0xa80 <cm_setCLKControl+0x34>
+ a62:	18 f0       	brcs	.+6      	; 0xa6a <cm_setCLKControl+0x1e>
+ a64:	62 30       	cpi	r22, 0x02	; 2
+ a66:	b9 f0       	breq	.+46     	; 0xa96 <cm_setCLKControl+0x4a>
+ a68:	20 c0       	rjmp	.+64     	; 0xaaa <cm_setCLKControl+0x5e>
+ a6a:	af 01       	movw	r20, r30
+ a6c:	46 5f       	subi	r20, 0xF6	; 246
+ a6e:	5f 4f       	sbci	r21, 0xFF	; 255
+ a70:	01 e0       	ldi	r16, 0x01	; 1
+ a72:	10 e0       	ldi	r17, 0x00	; 0
+ a74:	20 e0       	ldi	r18, 0x00	; 0
+ a76:	30 e0       	ldi	r19, 0x00	; 0
+ a78:	60 e1       	ldi	r22, 0x10	; 16
+ a7a:	cf 01       	movw	r24, r30
+ a7c:	2e df       	rcall	.-420    	; 0x8da <writeRegister>
+ a7e:	15 c0       	rjmp	.+42     	; 0xaaa <cm_setCLKControl+0x5e>
+ a80:	af 01       	movw	r20, r30
+ a82:	46 5f       	subi	r20, 0xF6	; 246
+ a84:	5f 4f       	sbci	r21, 0xFF	; 255
+ a86:	01 e0       	ldi	r16, 0x01	; 1
+ a88:	10 e0       	ldi	r17, 0x00	; 0
+ a8a:	20 e0       	ldi	r18, 0x00	; 0
+ a8c:	30 e0       	ldi	r19, 0x00	; 0
+ a8e:	61 e1       	ldi	r22, 0x11	; 17
+ a90:	cf 01       	movw	r24, r30
+ a92:	23 df       	rcall	.-442    	; 0x8da <writeRegister>
+ a94:	0a c0       	rjmp	.+20     	; 0xaaa <cm_setCLKControl+0x5e>
+ a96:	af 01       	movw	r20, r30
+ a98:	46 5f       	subi	r20, 0xF6	; 246
+ a9a:	5f 4f       	sbci	r21, 0xFF	; 255
+ a9c:	01 e0       	ldi	r16, 0x01	; 1
+ a9e:	10 e0       	ldi	r17, 0x00	; 0
+ aa0:	20 e0       	ldi	r18, 0x00	; 0
+ aa2:	30 e0       	ldi	r19, 0x00	; 0
+ aa4:	62 e1       	ldi	r22, 0x12	; 18
+ aa6:	cf 01       	movw	r24, r30
+ aa8:	18 df       	rcall	.-464    	; 0x8da <writeRegister>
+ aaa:	80 e0       	ldi	r24, 0x00	; 0
+ aac:	90 e0       	ldi	r25, 0x00	; 0
+ aae:	1f 91       	pop	r17
+ ab0:	0f 91       	pop	r16
+ ab2:	08 95       	ret
 
-00000aa4 <cm_resetPLLs>:
- aa4:	0f 93       	push	r16
- aa6:	1f 93       	push	r17
- aa8:	31 e0       	ldi	r19, 0x01	; 1
- aaa:	61 11       	cpse	r22, r1
- aac:	01 c0       	rjmp	.+2      	; 0xab0 <cm_resetPLLs+0xc>
- aae:	30 e0       	ldi	r19, 0x00	; 0
- ab0:	fc 01       	movw	r30, r24
- ab2:	26 8d       	ldd	r18, Z+30	; 0x1e
- ab4:	30 fb       	bst	r19, 0
- ab6:	25 f9       	bld	r18, 5
- ab8:	26 8f       	std	Z+30, r18	; 0x1e
- aba:	31 e0       	ldi	r19, 0x01	; 1
- abc:	41 11       	cpse	r20, r1
- abe:	01 c0       	rjmp	.+2      	; 0xac2 <cm_resetPLLs+0x1e>
- ac0:	30 e0       	ldi	r19, 0x00	; 0
+00000ab4 <cm_setInputSource>:
+ ab4:	0f 93       	push	r16
+ ab6:	1f 93       	push	r17
+ ab8:	66 23       	and	r22, r22
+ aba:	19 f0       	breq	.+6      	; 0xac2 <cm_setInputSource+0xe>
+ abc:	61 30       	cpi	r22, 0x01	; 1
+ abe:	39 f0       	breq	.+14     	; 0xace <cm_setInputSource+0x1a>
+ ac0:	0a c0       	rjmp	.+20     	; 0xad6 <cm_setInputSource+0x22>
  ac2:	fc 01       	movw	r30, r24
- ac4:	26 8d       	ldd	r18, Z+30	; 0x1e
- ac6:	30 fb       	bst	r19, 0
- ac8:	27 f9       	bld	r18, 7
- aca:	26 8f       	std	Z+30, r18	; 0x1e
- acc:	ac 01       	movw	r20, r24
- ace:	42 5e       	subi	r20, 0xE2	; 226
- ad0:	5f 4f       	sbci	r21, 0xFF	; 255
- ad2:	01 e0       	ldi	r16, 0x01	; 1
- ad4:	10 e0       	ldi	r17, 0x00	; 0
- ad6:	20 e0       	ldi	r18, 0x00	; 0
- ad8:	30 e0       	ldi	r19, 0x00	; 0
- ada:	61 eb       	ldi	r22, 0xB1	; 177
- adc:	d7 de       	rcall	.-594    	; 0x88c <writeRegister>
- ade:	80 e0       	ldi	r24, 0x00	; 0
- ae0:	90 e0       	ldi	r25, 0x00	; 0
- ae2:	1f 91       	pop	r17
- ae4:	0f 91       	pop	r16
- ae6:	08 95       	ret
+ ac4:	21 85       	ldd	r18, Z+9	; 0x09
+ ac6:	2b 7f       	andi	r18, 0xFB	; 251
+ ac8:	27 7f       	andi	r18, 0xF7	; 247
+ aca:	21 87       	std	Z+9, r18	; 0x09
+ acc:	04 c0       	rjmp	.+8      	; 0xad6 <cm_setInputSource+0x22>
+ ace:	fc 01       	movw	r30, r24
+ ad0:	21 85       	ldd	r18, Z+9	; 0x09
+ ad2:	24 60       	ori	r18, 0x04	; 4
+ ad4:	21 87       	std	Z+9, r18	; 0x09
+ ad6:	ac 01       	movw	r20, r24
+ ad8:	47 5f       	subi	r20, 0xF7	; 247
+ ada:	5f 4f       	sbci	r21, 0xFF	; 255
+ adc:	01 e0       	ldi	r16, 0x01	; 1
+ ade:	10 e0       	ldi	r17, 0x00	; 0
+ ae0:	20 e0       	ldi	r18, 0x00	; 0
+ ae2:	30 e0       	ldi	r19, 0x00	; 0
+ ae4:	60 ef       	ldi	r22, 0xF0	; 240
+ ae6:	f9 de       	rcall	.-526    	; 0x8da <writeRegister>
+ ae8:	80 e0       	ldi	r24, 0x00	; 0
+ aea:	90 e0       	ldi	r25, 0x00	; 0
+ aec:	1f 91       	pop	r17
+ aee:	0f 91       	pop	r16
+ af0:	08 95       	ret
 
-00000ae8 <cm_setPllParamRaw>:
- ae8:	af 92       	push	r10
- aea:	bf 92       	push	r11
- aec:	cf 92       	push	r12
- aee:	df 92       	push	r13
- af0:	ef 92       	push	r14
- af2:	ff 92       	push	r15
- af4:	0f 93       	push	r16
- af6:	1f 93       	push	r17
- af8:	cf 93       	push	r28
- afa:	df 93       	push	r29
- afc:	ec 01       	movw	r28, r24
- afe:	42 70       	andi	r20, 0x02	; 2
- b00:	8e 85       	ldd	r24, Y+14	; 0x0e
- b02:	8c 7f       	andi	r24, 0xFC	; 252
- b04:	48 2b       	or	r20, r24
- b06:	4e 87       	std	Y+14, r20	; 0x0e
- b08:	3f 87       	std	Y+15, r19	; 0x0f
- b0a:	28 8b       	std	Y+16, r18	; 0x10
- b0c:	d8 01       	movw	r26, r16
- b0e:	c7 01       	movw	r24, r14
- b10:	88 27       	eor	r24, r24
- b12:	99 27       	eor	r25, r25
- b14:	af 70       	andi	r26, 0x0F	; 15
- b16:	bb 27       	eor	r27, r27
- b18:	fa 8a       	std	Y+18, r15	; 0x12
- b1a:	eb 8a       	std	Y+19, r14	; 0x13
- b1c:	8a 2f       	mov	r24, r26
- b1e:	8f 70       	andi	r24, 0x0F	; 15
- b20:	89 8b       	std	Y+17, r24	; 0x11
- b22:	bc 86       	std	Y+12, r11	; 0x0c
- b24:	ad 86       	std	Y+13, r10	; 0x0d
- b26:	66 23       	and	r22, r22
- b28:	19 f0       	breq	.+6      	; 0xb30 <cm_setPllParamRaw+0x48>
- b2a:	61 30       	cpi	r22, 0x01	; 1
- b2c:	61 f0       	breq	.+24     	; 0xb46 <cm_setPllParamRaw+0x5e>
- b2e:	15 c0       	rjmp	.+42     	; 0xb5a <cm_setPllParamRaw+0x72>
- b30:	08 e0       	ldi	r16, 0x08	; 8
- b32:	10 e0       	ldi	r17, 0x00	; 0
- b34:	20 e0       	ldi	r18, 0x00	; 0
- b36:	30 e0       	ldi	r19, 0x00	; 0
- b38:	ae 01       	movw	r20, r28
- b3a:	44 5f       	subi	r20, 0xF4	; 244
- b3c:	5f 4f       	sbci	r21, 0xFF	; 255
- b3e:	6a e1       	ldi	r22, 0x1A	; 26
- b40:	ce 01       	movw	r24, r28
- b42:	a4 de       	rcall	.-696    	; 0x88c <writeRegister>
- b44:	0a c0       	rjmp	.+20     	; 0xb5a <cm_setPllParamRaw+0x72>
- b46:	08 e0       	ldi	r16, 0x08	; 8
- b48:	10 e0       	ldi	r17, 0x00	; 0
- b4a:	20 e0       	ldi	r18, 0x00	; 0
- b4c:	30 e0       	ldi	r19, 0x00	; 0
- b4e:	ae 01       	movw	r20, r28
- b50:	44 5f       	subi	r20, 0xF4	; 244
- b52:	5f 4f       	sbci	r21, 0xFF	; 255
- b54:	62 e2       	ldi	r22, 0x22	; 34
- b56:	ce 01       	movw	r24, r28
- b58:	99 de       	rcall	.-718    	; 0x88c <writeRegister>
- b5a:	41 e0       	ldi	r20, 0x01	; 1
- b5c:	61 e0       	ldi	r22, 0x01	; 1
- b5e:	ce 01       	movw	r24, r28
- b60:	a1 df       	rcall	.-190    	; 0xaa4 <cm_resetPLLs>
- b62:	80 e0       	ldi	r24, 0x00	; 0
- b64:	90 e0       	ldi	r25, 0x00	; 0
- b66:	df 91       	pop	r29
- b68:	cf 91       	pop	r28
- b6a:	1f 91       	pop	r17
- b6c:	0f 91       	pop	r16
- b6e:	ff 90       	pop	r15
- b70:	ef 90       	pop	r14
- b72:	df 90       	pop	r13
- b74:	cf 90       	pop	r12
- b76:	bf 90       	pop	r11
- b78:	af 90       	pop	r10
- b7a:	08 95       	ret
+00000af2 <cm_resetPLLs>:
+ af2:	0f 93       	push	r16
+ af4:	1f 93       	push	r17
+ af6:	31 e0       	ldi	r19, 0x01	; 1
+ af8:	61 11       	cpse	r22, r1
+ afa:	01 c0       	rjmp	.+2      	; 0xafe <cm_resetPLLs+0xc>
+ afc:	30 e0       	ldi	r19, 0x00	; 0
+ afe:	fc 01       	movw	r30, r24
+ b00:	26 8d       	ldd	r18, Z+30	; 0x1e
+ b02:	30 fb       	bst	r19, 0
+ b04:	25 f9       	bld	r18, 5
+ b06:	26 8f       	std	Z+30, r18	; 0x1e
+ b08:	31 e0       	ldi	r19, 0x01	; 1
+ b0a:	41 11       	cpse	r20, r1
+ b0c:	01 c0       	rjmp	.+2      	; 0xb10 <cm_resetPLLs+0x1e>
+ b0e:	30 e0       	ldi	r19, 0x00	; 0
+ b10:	fc 01       	movw	r30, r24
+ b12:	26 8d       	ldd	r18, Z+30	; 0x1e
+ b14:	30 fb       	bst	r19, 0
+ b16:	27 f9       	bld	r18, 7
+ b18:	26 8f       	std	Z+30, r18	; 0x1e
+ b1a:	ac 01       	movw	r20, r24
+ b1c:	42 5e       	subi	r20, 0xE2	; 226
+ b1e:	5f 4f       	sbci	r21, 0xFF	; 255
+ b20:	01 e0       	ldi	r16, 0x01	; 1
+ b22:	10 e0       	ldi	r17, 0x00	; 0
+ b24:	20 e0       	ldi	r18, 0x00	; 0
+ b26:	30 e0       	ldi	r19, 0x00	; 0
+ b28:	61 eb       	ldi	r22, 0xB1	; 177
+ b2a:	d7 de       	rcall	.-594    	; 0x8da <writeRegister>
+ b2c:	80 e0       	ldi	r24, 0x00	; 0
+ b2e:	90 e0       	ldi	r25, 0x00	; 0
+ b30:	1f 91       	pop	r17
+ b32:	0f 91       	pop	r16
+ b34:	08 95       	ret
 
-00000b7c <cm_si5351_init>:
+00000b36 <cm_setPllParamRaw>:
+ b36:	af 92       	push	r10
+ b38:	bf 92       	push	r11
+ b3a:	cf 92       	push	r12
+ b3c:	df 92       	push	r13
+ b3e:	ef 92       	push	r14
+ b40:	ff 92       	push	r15
+ b42:	0f 93       	push	r16
+ b44:	1f 93       	push	r17
+ b46:	cf 93       	push	r28
+ b48:	df 93       	push	r29
+ b4a:	ec 01       	movw	r28, r24
+ b4c:	42 70       	andi	r20, 0x02	; 2
+ b4e:	8e 85       	ldd	r24, Y+14	; 0x0e
+ b50:	8c 7f       	andi	r24, 0xFC	; 252
+ b52:	48 2b       	or	r20, r24
+ b54:	4e 87       	std	Y+14, r20	; 0x0e
+ b56:	3f 87       	std	Y+15, r19	; 0x0f
+ b58:	28 8b       	std	Y+16, r18	; 0x10
+ b5a:	d8 01       	movw	r26, r16
+ b5c:	c7 01       	movw	r24, r14
+ b5e:	88 27       	eor	r24, r24
+ b60:	99 27       	eor	r25, r25
+ b62:	af 70       	andi	r26, 0x0F	; 15
+ b64:	bb 27       	eor	r27, r27
+ b66:	fa 8a       	std	Y+18, r15	; 0x12
+ b68:	eb 8a       	std	Y+19, r14	; 0x13
+ b6a:	8a 2f       	mov	r24, r26
+ b6c:	8f 70       	andi	r24, 0x0F	; 15
+ b6e:	89 8b       	std	Y+17, r24	; 0x11
+ b70:	bc 86       	std	Y+12, r11	; 0x0c
+ b72:	ad 86       	std	Y+13, r10	; 0x0d
+ b74:	66 23       	and	r22, r22
+ b76:	19 f0       	breq	.+6      	; 0xb7e <cm_setPllParamRaw+0x48>
+ b78:	61 30       	cpi	r22, 0x01	; 1
+ b7a:	61 f0       	breq	.+24     	; 0xb94 <cm_setPllParamRaw+0x5e>
+ b7c:	15 c0       	rjmp	.+42     	; 0xba8 <cm_setPllParamRaw+0x72>
+ b7e:	08 e0       	ldi	r16, 0x08	; 8
+ b80:	10 e0       	ldi	r17, 0x00	; 0
+ b82:	20 e0       	ldi	r18, 0x00	; 0
+ b84:	30 e0       	ldi	r19, 0x00	; 0
+ b86:	ae 01       	movw	r20, r28
+ b88:	44 5f       	subi	r20, 0xF4	; 244
+ b8a:	5f 4f       	sbci	r21, 0xFF	; 255
+ b8c:	6a e1       	ldi	r22, 0x1A	; 26
+ b8e:	ce 01       	movw	r24, r28
+ b90:	a4 de       	rcall	.-696    	; 0x8da <writeRegister>
+ b92:	0a c0       	rjmp	.+20     	; 0xba8 <cm_setPllParamRaw+0x72>
+ b94:	08 e0       	ldi	r16, 0x08	; 8
+ b96:	10 e0       	ldi	r17, 0x00	; 0
+ b98:	20 e0       	ldi	r18, 0x00	; 0
+ b9a:	30 e0       	ldi	r19, 0x00	; 0
+ b9c:	ae 01       	movw	r20, r28
+ b9e:	44 5f       	subi	r20, 0xF4	; 244
+ ba0:	5f 4f       	sbci	r21, 0xFF	; 255
+ ba2:	62 e2       	ldi	r22, 0x22	; 34
+ ba4:	ce 01       	movw	r24, r28
+ ba6:	99 de       	rcall	.-718    	; 0x8da <writeRegister>
+ ba8:	41 e0       	ldi	r20, 0x01	; 1
+ baa:	61 e0       	ldi	r22, 0x01	; 1
+ bac:	ce 01       	movw	r24, r28
+ bae:	a1 df       	rcall	.-190    	; 0xaf2 <cm_resetPLLs>
+ bb0:	80 e0       	ldi	r24, 0x00	; 0
+ bb2:	90 e0       	ldi	r25, 0x00	; 0
+ bb4:	df 91       	pop	r29
+ bb6:	cf 91       	pop	r28
+ bb8:	1f 91       	pop	r17
+ bba:	0f 91       	pop	r16
+ bbc:	ff 90       	pop	r15
+ bbe:	ef 90       	pop	r14
+ bc0:	df 90       	pop	r13
+ bc2:	cf 90       	pop	r12
+ bc4:	bf 90       	pop	r11
+ bc6:	af 90       	pop	r10
+ bc8:	08 95       	ret
+
+00000bca <cm_si5351_init>:
 
 int cm_si5351_init(si5351_driver *inst, void *i2c_transfer_inst, setGet_I2C_Event_fpt i2c_transfer_evt){
- b7c:	ef 92       	push	r14
- b7e:	ff 92       	push	r15
- b80:	0f 93       	push	r16
- b82:	1f 93       	push	r17
- b84:	cf 93       	push	r28
- b86:	df 93       	push	r29
- b88:	1f 92       	push	r1
- b8a:	cd b7       	in	r28, 0x3d	; 61
- b8c:	de b7       	in	r29, 0x3e	; 62
+ bca:	ef 92       	push	r14
+ bcc:	ff 92       	push	r15
+ bce:	0f 93       	push	r16
+ bd0:	1f 93       	push	r17
+ bd2:	cf 93       	push	r28
+ bd4:	df 93       	push	r29
+ bd6:	1f 92       	push	r1
+ bd8:	cd b7       	in	r28, 0x3d	; 61
+ bda:	de b7       	in	r29, 0x3e	; 62
 
 	if(inst == NULL)return -1;
- b8e:	00 97       	sbiw	r24, 0x00	; 0
- b90:	09 f4       	brne	.+2      	; 0xb94 <cm_si5351_init+0x18>
- b92:	91 c0       	rjmp	.+290    	; 0xcb6 <cm_si5351_init+0x13a>
+ bdc:	00 97       	sbiw	r24, 0x00	; 0
+ bde:	09 f4       	brne	.+2      	; 0xbe2 <cm_si5351_init+0x18>
+ be0:	91 c0       	rjmp	.+290    	; 0xd04 <cm_si5351_init+0x13a>
 	if(i2c_transfer_inst == NULL)return -1;
- b94:	61 15       	cp	r22, r1
- b96:	71 05       	cpc	r23, r1
- b98:	09 f4       	brne	.+2      	; 0xb9c <cm_si5351_init+0x20>
- b9a:	90 c0       	rjmp	.+288    	; 0xcbc <cm_si5351_init+0x140>
+ be2:	61 15       	cp	r22, r1
+ be4:	71 05       	cpc	r23, r1
+ be6:	09 f4       	brne	.+2      	; 0xbea <cm_si5351_init+0x20>
+ be8:	90 c0       	rjmp	.+288    	; 0xd0a <cm_si5351_init+0x140>
 	if(i2c_transfer_evt == NULL)return -1;
- b9c:	41 15       	cp	r20, r1
- b9e:	51 05       	cpc	r21, r1
- ba0:	09 f4       	brne	.+2      	; 0xba4 <cm_si5351_init+0x28>
- ba2:	8f c0       	rjmp	.+286    	; 0xcc2 <cm_si5351_init+0x146>
- ba4:	7c 01       	movw	r14, r24
+ bea:	41 15       	cp	r20, r1
+ bec:	51 05       	cpc	r21, r1
+ bee:	09 f4       	brne	.+2      	; 0xbf2 <cm_si5351_init+0x28>
+ bf0:	8f c0       	rjmp	.+286    	; 0xd10 <cm_si5351_init+0x146>
+ bf2:	7c 01       	movw	r14, r24
 
 	inst->i2c_transfer_inst = i2c_transfer_inst;
- ba6:	dc 01       	movw	r26, r24
- ba8:	6d 93       	st	X+, r22
- baa:	7c 93       	st	X, r23
- bac:	11 97       	sbiw	r26, 0x01	; 1
+ bf4:	dc 01       	movw	r26, r24
+ bf6:	6d 93       	st	X+, r22
+ bf8:	7c 93       	st	X, r23
+ bfa:	11 97       	sbiw	r26, 0x01	; 1
 	inst->i2c_transfer_evt = i2c_transfer_evt;
- bae:	12 96       	adiw	r26, 0x02	; 2
- bb0:	4d 93       	st	X+, r20
- bb2:	5c 93       	st	X, r21
- bb4:	13 97       	sbiw	r26, 0x03	; 3
+ bfc:	12 96       	adiw	r26, 0x02	; 2
+ bfe:	4d 93       	st	X+, r20
+ c00:	5c 93       	st	X, r21
+ c02:	13 97       	sbiw	r26, 0x03	; 3
 
 	int ret = 0;
 
 	memset(&(inst->device_data),0x00,sizeof(si5351_data));
- bb6:	fc 01       	movw	r30, r24
- bb8:	34 96       	adiw	r30, 0x04	; 4
- bba:	8b e1       	ldi	r24, 0x1B	; 27
- bbc:	df 01       	movw	r26, r30
- bbe:	1d 92       	st	X+, r1
- bc0:	8a 95       	dec	r24
- bc2:	e9 f7       	brne	.-6      	; 0xbbe <cm_si5351_init+0x42>
+ c04:	fc 01       	movw	r30, r24
+ c06:	34 96       	adiw	r30, 0x04	; 4
+ c08:	8b e1       	ldi	r24, 0x1B	; 27
+ c0a:	df 01       	movw	r26, r30
+ c0c:	1d 92       	st	X+, r1
+ c0e:	8a 95       	dec	r24
+ c10:	e9 f7       	brne	.-6      	; 0xc0c <cm_si5351_init+0x42>
 
 	/* Disable all outputs setting CLKx_DIS high */
 	uint8_t temp = 0xff;
- bc4:	8f ef       	ldi	r24, 0xFF	; 255
- bc6:	89 83       	std	Y+1, r24	; 0x01
+ c12:	8f ef       	ldi	r24, 0xFF	; 255
+ c14:	89 83       	std	Y+1, r24	; 0x01
 	writeRegister(inst,SI5351_REG_OUTPUT_ENABLE_CONTROL,&temp,1);
- bc8:	01 e0       	ldi	r16, 0x01	; 1
- bca:	10 e0       	ldi	r17, 0x00	; 0
- bcc:	20 e0       	ldi	r18, 0x00	; 0
- bce:	30 e0       	ldi	r19, 0x00	; 0
- bd0:	ae 01       	movw	r20, r28
- bd2:	4f 5f       	subi	r20, 0xFF	; 255
- bd4:	5f 4f       	sbci	r21, 0xFF	; 255
- bd6:	63 e0       	ldi	r22, 0x03	; 3
- bd8:	c7 01       	movw	r24, r14
- bda:	58 de       	rcall	.-848    	; 0x88c <writeRegister>
+ c16:	01 e0       	ldi	r16, 0x01	; 1
+ c18:	10 e0       	ldi	r17, 0x00	; 0
+ c1a:	20 e0       	ldi	r18, 0x00	; 0
+ c1c:	30 e0       	ldi	r19, 0x00	; 0
+ c1e:	ae 01       	movw	r20, r28
+ c20:	4f 5f       	subi	r20, 0xFF	; 255
+ c22:	5f 4f       	sbci	r21, 0xFF	; 255
+ c24:	63 e0       	ldi	r22, 0x03	; 3
+ c26:	c7 01       	movw	r24, r14
+ c28:	58 de       	rcall	.-848    	; 0x8da <writeRegister>
 
 	/* Power down all output drivers */
 	temp = 0x80;
- bdc:	80 e8       	ldi	r24, 0x80	; 128
- bde:	89 83       	std	Y+1, r24	; 0x01
+ c2a:	80 e8       	ldi	r24, 0x80	; 128
+ c2c:	89 83       	std	Y+1, r24	; 0x01
 	writeRegister(inst,SI5351_REG_CLK_0_CONTROL,&temp,1);
- be0:	01 e0       	ldi	r16, 0x01	; 1
- be2:	10 e0       	ldi	r17, 0x00	; 0
- be4:	20 e0       	ldi	r18, 0x00	; 0
- be6:	30 e0       	ldi	r19, 0x00	; 0
- be8:	ae 01       	movw	r20, r28
- bea:	4f 5f       	subi	r20, 0xFF	; 255
- bec:	5f 4f       	sbci	r21, 0xFF	; 255
- bee:	60 e1       	ldi	r22, 0x10	; 16
- bf0:	c7 01       	movw	r24, r14
- bf2:	4c de       	rcall	.-872    	; 0x88c <writeRegister>
+ c2e:	01 e0       	ldi	r16, 0x01	; 1
+ c30:	10 e0       	ldi	r17, 0x00	; 0
+ c32:	20 e0       	ldi	r18, 0x00	; 0
+ c34:	30 e0       	ldi	r19, 0x00	; 0
+ c36:	ae 01       	movw	r20, r28
+ c38:	4f 5f       	subi	r20, 0xFF	; 255
+ c3a:	5f 4f       	sbci	r21, 0xFF	; 255
+ c3c:	60 e1       	ldi	r22, 0x10	; 16
+ c3e:	c7 01       	movw	r24, r14
+ c40:	4c de       	rcall	.-872    	; 0x8da <writeRegister>
 	writeRegister(inst,SI5351_REG_CLK_1_CONTROL,&temp,1);
- bf4:	01 e0       	ldi	r16, 0x01	; 1
- bf6:	10 e0       	ldi	r17, 0x00	; 0
- bf8:	20 e0       	ldi	r18, 0x00	; 0
- bfa:	30 e0       	ldi	r19, 0x00	; 0
- bfc:	ae 01       	movw	r20, r28
- bfe:	4f 5f       	subi	r20, 0xFF	; 255
- c00:	5f 4f       	sbci	r21, 0xFF	; 255
- c02:	61 e1       	ldi	r22, 0x11	; 17
- c04:	c7 01       	movw	r24, r14
- c06:	42 de       	rcall	.-892    	; 0x88c <writeRegister>
+ c42:	01 e0       	ldi	r16, 0x01	; 1
+ c44:	10 e0       	ldi	r17, 0x00	; 0
+ c46:	20 e0       	ldi	r18, 0x00	; 0
+ c48:	30 e0       	ldi	r19, 0x00	; 0
+ c4a:	ae 01       	movw	r20, r28
+ c4c:	4f 5f       	subi	r20, 0xFF	; 255
+ c4e:	5f 4f       	sbci	r21, 0xFF	; 255
+ c50:	61 e1       	ldi	r22, 0x11	; 17
+ c52:	c7 01       	movw	r24, r14
+ c54:	42 de       	rcall	.-892    	; 0x8da <writeRegister>
 	writeRegister(inst,SI5351_REG_CLK_2_CONTROL,&temp,1);
- c08:	01 e0       	ldi	r16, 0x01	; 1
- c0a:	10 e0       	ldi	r17, 0x00	; 0
- c0c:	20 e0       	ldi	r18, 0x00	; 0
- c0e:	30 e0       	ldi	r19, 0x00	; 0
- c10:	ae 01       	movw	r20, r28
- c12:	4f 5f       	subi	r20, 0xFF	; 255
- c14:	5f 4f       	sbci	r21, 0xFF	; 255
- c16:	62 e1       	ldi	r22, 0x12	; 18
- c18:	c7 01       	movw	r24, r14
- c1a:	38 de       	rcall	.-912    	; 0x88c <writeRegister>
+ c56:	01 e0       	ldi	r16, 0x01	; 1
+ c58:	10 e0       	ldi	r17, 0x00	; 0
+ c5a:	20 e0       	ldi	r18, 0x00	; 0
+ c5c:	30 e0       	ldi	r19, 0x00	; 0
+ c5e:	ae 01       	movw	r20, r28
+ c60:	4f 5f       	subi	r20, 0xFF	; 255
+ c62:	5f 4f       	sbci	r21, 0xFF	; 255
+ c64:	62 e1       	ldi	r22, 0x12	; 18
+ c66:	c7 01       	movw	r24, r14
+ c68:	38 de       	rcall	.-912    	; 0x8da <writeRegister>
 	writeRegister(inst,SI5351_REG_CLK_3_CONTROL,&temp,1);
- c1c:	01 e0       	ldi	r16, 0x01	; 1
- c1e:	10 e0       	ldi	r17, 0x00	; 0
- c20:	20 e0       	ldi	r18, 0x00	; 0
- c22:	30 e0       	ldi	r19, 0x00	; 0
- c24:	ae 01       	movw	r20, r28
- c26:	4f 5f       	subi	r20, 0xFF	; 255
- c28:	5f 4f       	sbci	r21, 0xFF	; 255
- c2a:	63 e1       	ldi	r22, 0x13	; 19
- c2c:	c7 01       	movw	r24, r14
- c2e:	2e de       	rcall	.-932    	; 0x88c <writeRegister>
+ c6a:	01 e0       	ldi	r16, 0x01	; 1
+ c6c:	10 e0       	ldi	r17, 0x00	; 0
+ c6e:	20 e0       	ldi	r18, 0x00	; 0
+ c70:	30 e0       	ldi	r19, 0x00	; 0
+ c72:	ae 01       	movw	r20, r28
+ c74:	4f 5f       	subi	r20, 0xFF	; 255
+ c76:	5f 4f       	sbci	r21, 0xFF	; 255
+ c78:	63 e1       	ldi	r22, 0x13	; 19
+ c7a:	c7 01       	movw	r24, r14
+ c7c:	2e de       	rcall	.-932    	; 0x8da <writeRegister>
 	writeRegister(inst,SI5351_REG_CLK_4_CONTROL,&temp,1);
- c30:	01 e0       	ldi	r16, 0x01	; 1
- c32:	10 e0       	ldi	r17, 0x00	; 0
- c34:	20 e0       	ldi	r18, 0x00	; 0
- c36:	30 e0       	ldi	r19, 0x00	; 0
- c38:	ae 01       	movw	r20, r28
- c3a:	4f 5f       	subi	r20, 0xFF	; 255
- c3c:	5f 4f       	sbci	r21, 0xFF	; 255
- c3e:	64 e1       	ldi	r22, 0x14	; 20
- c40:	c7 01       	movw	r24, r14
- c42:	24 de       	rcall	.-952    	; 0x88c <writeRegister>
+ c7e:	01 e0       	ldi	r16, 0x01	; 1
+ c80:	10 e0       	ldi	r17, 0x00	; 0
+ c82:	20 e0       	ldi	r18, 0x00	; 0
+ c84:	30 e0       	ldi	r19, 0x00	; 0
+ c86:	ae 01       	movw	r20, r28
+ c88:	4f 5f       	subi	r20, 0xFF	; 255
+ c8a:	5f 4f       	sbci	r21, 0xFF	; 255
+ c8c:	64 e1       	ldi	r22, 0x14	; 20
+ c8e:	c7 01       	movw	r24, r14
+ c90:	24 de       	rcall	.-952    	; 0x8da <writeRegister>
 	writeRegister(inst,SI5351_REG_CLK_5_CONTROL,&temp,1);
- c44:	01 e0       	ldi	r16, 0x01	; 1
- c46:	10 e0       	ldi	r17, 0x00	; 0
- c48:	20 e0       	ldi	r18, 0x00	; 0
- c4a:	30 e0       	ldi	r19, 0x00	; 0
- c4c:	ae 01       	movw	r20, r28
- c4e:	4f 5f       	subi	r20, 0xFF	; 255
- c50:	5f 4f       	sbci	r21, 0xFF	; 255
- c52:	65 e1       	ldi	r22, 0x15	; 21
- c54:	c7 01       	movw	r24, r14
- c56:	1a de       	rcall	.-972    	; 0x88c <writeRegister>
+ c92:	01 e0       	ldi	r16, 0x01	; 1
+ c94:	10 e0       	ldi	r17, 0x00	; 0
+ c96:	20 e0       	ldi	r18, 0x00	; 0
+ c98:	30 e0       	ldi	r19, 0x00	; 0
+ c9a:	ae 01       	movw	r20, r28
+ c9c:	4f 5f       	subi	r20, 0xFF	; 255
+ c9e:	5f 4f       	sbci	r21, 0xFF	; 255
+ ca0:	65 e1       	ldi	r22, 0x15	; 21
+ ca2:	c7 01       	movw	r24, r14
+ ca4:	1a de       	rcall	.-972    	; 0x8da <writeRegister>
 	writeRegister(inst,SI5351_REG_CLK_6_CONTROL,&temp,1);
- c58:	01 e0       	ldi	r16, 0x01	; 1
- c5a:	10 e0       	ldi	r17, 0x00	; 0
- c5c:	20 e0       	ldi	r18, 0x00	; 0
- c5e:	30 e0       	ldi	r19, 0x00	; 0
- c60:	ae 01       	movw	r20, r28
- c62:	4f 5f       	subi	r20, 0xFF	; 255
- c64:	5f 4f       	sbci	r21, 0xFF	; 255
- c66:	66 e1       	ldi	r22, 0x16	; 22
- c68:	c7 01       	movw	r24, r14
- c6a:	10 de       	rcall	.-992    	; 0x88c <writeRegister>
+ ca6:	01 e0       	ldi	r16, 0x01	; 1
+ ca8:	10 e0       	ldi	r17, 0x00	; 0
+ caa:	20 e0       	ldi	r18, 0x00	; 0
+ cac:	30 e0       	ldi	r19, 0x00	; 0
+ cae:	ae 01       	movw	r20, r28
+ cb0:	4f 5f       	subi	r20, 0xFF	; 255
+ cb2:	5f 4f       	sbci	r21, 0xFF	; 255
+ cb4:	66 e1       	ldi	r22, 0x16	; 22
+ cb6:	c7 01       	movw	r24, r14
+ cb8:	10 de       	rcall	.-992    	; 0x8da <writeRegister>
 	writeRegister(inst,SI5351_REG_CLK_7_CONTROL,&temp,1);
- c6c:	01 e0       	ldi	r16, 0x01	; 1
- c6e:	10 e0       	ldi	r17, 0x00	; 0
- c70:	20 e0       	ldi	r18, 0x00	; 0
- c72:	30 e0       	ldi	r19, 0x00	; 0
- c74:	ae 01       	movw	r20, r28
- c76:	4f 5f       	subi	r20, 0xFF	; 255
- c78:	5f 4f       	sbci	r21, 0xFF	; 255
- c7a:	67 e1       	ldi	r22, 0x17	; 23
- c7c:	c7 01       	movw	r24, r14
- c7e:	06 de       	rcall	.-1012   	; 0x88c <writeRegister>
+ cba:	01 e0       	ldi	r16, 0x01	; 1
+ cbc:	10 e0       	ldi	r17, 0x00	; 0
+ cbe:	20 e0       	ldi	r18, 0x00	; 0
+ cc0:	30 e0       	ldi	r19, 0x00	; 0
+ cc2:	ae 01       	movw	r20, r28
+ cc4:	4f 5f       	subi	r20, 0xFF	; 255
+ cc6:	5f 4f       	sbci	r21, 0xFF	; 255
+ cc8:	67 e1       	ldi	r22, 0x17	; 23
+ cca:	c7 01       	movw	r24, r14
+ ccc:	06 de       	rcall	.-1012   	; 0x8da <writeRegister>
 
 	temp = SI5351_CRYSTAL_LOAD_10PF;
- c80:	80 ec       	ldi	r24, 0xC0	; 192
- c82:	89 83       	std	Y+1, r24	; 0x01
+ cce:	80 ec       	ldi	r24, 0xC0	; 192
+ cd0:	89 83       	std	Y+1, r24	; 0x01
 
 	writeRegister(inst,SI5351_REG_CRYSTAL_LOAD_CAPACITANCE,&temp,1);
- c84:	01 e0       	ldi	r16, 0x01	; 1
- c86:	10 e0       	ldi	r17, 0x00	; 0
- c88:	20 e0       	ldi	r18, 0x00	; 0
- c8a:	30 e0       	ldi	r19, 0x00	; 0
- c8c:	ae 01       	movw	r20, r28
- c8e:	4f 5f       	subi	r20, 0xFF	; 255
- c90:	5f 4f       	sbci	r21, 0xFF	; 255
- c92:	67 eb       	ldi	r22, 0xB7	; 183
- c94:	c7 01       	movw	r24, r14
- c96:	fa dd       	rcall	.-1036   	; 0x88c <writeRegister>
+ cd2:	01 e0       	ldi	r16, 0x01	; 1
+ cd4:	10 e0       	ldi	r17, 0x00	; 0
+ cd6:	20 e0       	ldi	r18, 0x00	; 0
+ cd8:	30 e0       	ldi	r19, 0x00	; 0
+ cda:	ae 01       	movw	r20, r28
+ cdc:	4f 5f       	subi	r20, 0xFF	; 255
+ cde:	5f 4f       	sbci	r21, 0xFF	; 255
+ ce0:	67 eb       	ldi	r22, 0xB7	; 183
+ ce2:	c7 01       	movw	r24, r14
+ ce4:	fa dd       	rcall	.-1036   	; 0x8da <writeRegister>
 	
 	// Enable xtal clk..
 	temp = 0b01000000;
- c98:	80 e4       	ldi	r24, 0x40	; 64
- c9a:	89 83       	std	Y+1, r24	; 0x01
+ ce6:	80 e4       	ldi	r24, 0x40	; 64
+ ce8:	89 83       	std	Y+1, r24	; 0x01
 	writeRegister(inst,SI5351_REG_FANOUT_ENABLE,&temp,1);
- c9c:	01 e0       	ldi	r16, 0x01	; 1
- c9e:	10 e0       	ldi	r17, 0x00	; 0
- ca0:	20 e0       	ldi	r18, 0x00	; 0
- ca2:	30 e0       	ldi	r19, 0x00	; 0
- ca4:	ae 01       	movw	r20, r28
- ca6:	4f 5f       	subi	r20, 0xFF	; 255
- ca8:	5f 4f       	sbci	r21, 0xFF	; 255
- caa:	6b eb       	ldi	r22, 0xBB	; 187
- cac:	c7 01       	movw	r24, r14
- cae:	ee dd       	rcall	.-1060   	; 0x88c <writeRegister>
+ cea:	01 e0       	ldi	r16, 0x01	; 1
+ cec:	10 e0       	ldi	r17, 0x00	; 0
+ cee:	20 e0       	ldi	r18, 0x00	; 0
+ cf0:	30 e0       	ldi	r19, 0x00	; 0
+ cf2:	ae 01       	movw	r20, r28
+ cf4:	4f 5f       	subi	r20, 0xFF	; 255
+ cf6:	5f 4f       	sbci	r21, 0xFF	; 255
+ cf8:	6b eb       	ldi	r22, 0xBB	; 187
+ cfa:	c7 01       	movw	r24, r14
+ cfc:	ee dd       	rcall	.-1060   	; 0x8da <writeRegister>
 	return ret;
- cb0:	80 e0       	ldi	r24, 0x00	; 0
- cb2:	90 e0       	ldi	r25, 0x00	; 0
- cb4:	08 c0       	rjmp	.+16     	; 0xcc6 <cm_si5351_init+0x14a>
+ cfe:	80 e0       	ldi	r24, 0x00	; 0
+ d00:	90 e0       	ldi	r25, 0x00	; 0
+ d02:	08 c0       	rjmp	.+16     	; 0xd14 <cm_si5351_init+0x14a>
 	return inst->device_data.deviceStatus.REVID;
 }
 
 int cm_si5351_init(si5351_driver *inst, void *i2c_transfer_inst, setGet_I2C_Event_fpt i2c_transfer_evt){
 
 	if(inst == NULL)return -1;
- cb6:	8f ef       	ldi	r24, 0xFF	; 255
- cb8:	9f ef       	ldi	r25, 0xFF	; 255
- cba:	05 c0       	rjmp	.+10     	; 0xcc6 <cm_si5351_init+0x14a>
+ d04:	8f ef       	ldi	r24, 0xFF	; 255
+ d06:	9f ef       	ldi	r25, 0xFF	; 255
+ d08:	05 c0       	rjmp	.+10     	; 0xd14 <cm_si5351_init+0x14a>
 	if(i2c_transfer_inst == NULL)return -1;
- cbc:	8f ef       	ldi	r24, 0xFF	; 255
- cbe:	9f ef       	ldi	r25, 0xFF	; 255
- cc0:	02 c0       	rjmp	.+4      	; 0xcc6 <cm_si5351_init+0x14a>
+ d0a:	8f ef       	ldi	r24, 0xFF	; 255
+ d0c:	9f ef       	ldi	r25, 0xFF	; 255
+ d0e:	02 c0       	rjmp	.+4      	; 0xd14 <cm_si5351_init+0x14a>
 	if(i2c_transfer_evt == NULL)return -1;
- cc2:	8f ef       	ldi	r24, 0xFF	; 255
- cc4:	9f ef       	ldi	r25, 0xFF	; 255
+ d10:	8f ef       	ldi	r24, 0xFF	; 255
+ d12:	9f ef       	ldi	r25, 0xFF	; 255
 	writeRegister(inst,SI5351_REG_FANOUT_ENABLE,&temp,1);
 	return ret;
 
 
 
 }
- cc6:	0f 90       	pop	r0
- cc8:	df 91       	pop	r29
- cca:	cf 91       	pop	r28
- ccc:	1f 91       	pop	r17
- cce:	0f 91       	pop	r16
- cd0:	ff 90       	pop	r15
- cd2:	ef 90       	pop	r14
- cd4:	08 95       	ret
+ d14:	0f 90       	pop	r0
+ d16:	df 91       	pop	r29
+ d18:	cf 91       	pop	r28
+ d1a:	1f 91       	pop	r17
+ d1c:	0f 91       	pop	r16
+ d1e:	ff 90       	pop	r15
+ d20:	ef 90       	pop	r14
+ d22:	08 95       	ret
 
-00000cd6 <malloc>:
- cd6:	0f 93       	push	r16
- cd8:	1f 93       	push	r17
- cda:	cf 93       	push	r28
- cdc:	df 93       	push	r29
- cde:	82 30       	cpi	r24, 0x02	; 2
- ce0:	91 05       	cpc	r25, r1
- ce2:	10 f4       	brcc	.+4      	; 0xce8 <malloc+0x12>
- ce4:	82 e0       	ldi	r24, 0x02	; 2
- ce6:	90 e0       	ldi	r25, 0x00	; 0
- ce8:	e0 91 88 3f 	lds	r30, 0x3F88	; 0x803f88 <__flp>
- cec:	f0 91 89 3f 	lds	r31, 0x3F89	; 0x803f89 <__flp+0x1>
- cf0:	20 e0       	ldi	r18, 0x00	; 0
- cf2:	30 e0       	ldi	r19, 0x00	; 0
- cf4:	a0 e0       	ldi	r26, 0x00	; 0
- cf6:	b0 e0       	ldi	r27, 0x00	; 0
- cf8:	30 97       	sbiw	r30, 0x00	; 0
- cfa:	19 f1       	breq	.+70     	; 0xd42 <malloc+0x6c>
- cfc:	40 81       	ld	r20, Z
- cfe:	51 81       	ldd	r21, Z+1	; 0x01
- d00:	02 81       	ldd	r16, Z+2	; 0x02
- d02:	13 81       	ldd	r17, Z+3	; 0x03
- d04:	48 17       	cp	r20, r24
- d06:	59 07       	cpc	r21, r25
- d08:	c8 f0       	brcs	.+50     	; 0xd3c <malloc+0x66>
- d0a:	84 17       	cp	r24, r20
- d0c:	95 07       	cpc	r25, r21
- d0e:	69 f4       	brne	.+26     	; 0xd2a <malloc+0x54>
- d10:	10 97       	sbiw	r26, 0x00	; 0
- d12:	31 f0       	breq	.+12     	; 0xd20 <malloc+0x4a>
- d14:	12 96       	adiw	r26, 0x02	; 2
- d16:	0c 93       	st	X, r16
- d18:	12 97       	sbiw	r26, 0x02	; 2
- d1a:	13 96       	adiw	r26, 0x03	; 3
- d1c:	1c 93       	st	X, r17
- d1e:	27 c0       	rjmp	.+78     	; 0xd6e <malloc+0x98>
- d20:	00 93 88 3f 	sts	0x3F88, r16	; 0x803f88 <__flp>
- d24:	10 93 89 3f 	sts	0x3F89, r17	; 0x803f89 <__flp+0x1>
- d28:	22 c0       	rjmp	.+68     	; 0xd6e <malloc+0x98>
- d2a:	21 15       	cp	r18, r1
- d2c:	31 05       	cpc	r19, r1
- d2e:	19 f0       	breq	.+6      	; 0xd36 <malloc+0x60>
- d30:	42 17       	cp	r20, r18
- d32:	53 07       	cpc	r21, r19
- d34:	18 f4       	brcc	.+6      	; 0xd3c <malloc+0x66>
- d36:	9a 01       	movw	r18, r20
- d38:	bd 01       	movw	r22, r26
- d3a:	ef 01       	movw	r28, r30
- d3c:	df 01       	movw	r26, r30
- d3e:	f8 01       	movw	r30, r16
- d40:	db cf       	rjmp	.-74     	; 0xcf8 <malloc+0x22>
- d42:	21 15       	cp	r18, r1
- d44:	31 05       	cpc	r19, r1
- d46:	f9 f0       	breq	.+62     	; 0xd86 <malloc+0xb0>
- d48:	28 1b       	sub	r18, r24
- d4a:	39 0b       	sbc	r19, r25
- d4c:	24 30       	cpi	r18, 0x04	; 4
- d4e:	31 05       	cpc	r19, r1
- d50:	80 f4       	brcc	.+32     	; 0xd72 <malloc+0x9c>
- d52:	8a 81       	ldd	r24, Y+2	; 0x02
- d54:	9b 81       	ldd	r25, Y+3	; 0x03
- d56:	61 15       	cp	r22, r1
- d58:	71 05       	cpc	r23, r1
- d5a:	21 f0       	breq	.+8      	; 0xd64 <malloc+0x8e>
- d5c:	fb 01       	movw	r30, r22
- d5e:	82 83       	std	Z+2, r24	; 0x02
- d60:	93 83       	std	Z+3, r25	; 0x03
- d62:	04 c0       	rjmp	.+8      	; 0xd6c <malloc+0x96>
- d64:	80 93 88 3f 	sts	0x3F88, r24	; 0x803f88 <__flp>
- d68:	90 93 89 3f 	sts	0x3F89, r25	; 0x803f89 <__flp+0x1>
- d6c:	fe 01       	movw	r30, r28
- d6e:	32 96       	adiw	r30, 0x02	; 2
- d70:	44 c0       	rjmp	.+136    	; 0xdfa <malloc+0x124>
- d72:	fe 01       	movw	r30, r28
- d74:	e2 0f       	add	r30, r18
- d76:	f3 1f       	adc	r31, r19
- d78:	81 93       	st	Z+, r24
- d7a:	91 93       	st	Z+, r25
- d7c:	22 50       	subi	r18, 0x02	; 2
- d7e:	31 09       	sbc	r19, r1
- d80:	28 83       	st	Y, r18
- d82:	39 83       	std	Y+1, r19	; 0x01
- d84:	3a c0       	rjmp	.+116    	; 0xdfa <malloc+0x124>
- d86:	20 91 86 3f 	lds	r18, 0x3F86	; 0x803f86 <__brkval>
- d8a:	30 91 87 3f 	lds	r19, 0x3F87	; 0x803f87 <__brkval+0x1>
- d8e:	23 2b       	or	r18, r19
- d90:	41 f4       	brne	.+16     	; 0xda2 <malloc+0xcc>
- d92:	20 91 02 3f 	lds	r18, 0x3F02	; 0x803f02 <__malloc_heap_start>
- d96:	30 91 03 3f 	lds	r19, 0x3F03	; 0x803f03 <__malloc_heap_start+0x1>
- d9a:	20 93 86 3f 	sts	0x3F86, r18	; 0x803f86 <__brkval>
- d9e:	30 93 87 3f 	sts	0x3F87, r19	; 0x803f87 <__brkval+0x1>
- da2:	20 91 00 3f 	lds	r18, 0x3F00	; 0x803f00 <__DATA_REGION_ORIGIN__>
- da6:	30 91 01 3f 	lds	r19, 0x3F01	; 0x803f01 <__DATA_REGION_ORIGIN__+0x1>
- daa:	21 15       	cp	r18, r1
- dac:	31 05       	cpc	r19, r1
- dae:	41 f4       	brne	.+16     	; 0xdc0 <malloc+0xea>
- db0:	2d b7       	in	r18, 0x3d	; 61
- db2:	3e b7       	in	r19, 0x3e	; 62
- db4:	40 91 04 3f 	lds	r20, 0x3F04	; 0x803f04 <__malloc_margin>
- db8:	50 91 05 3f 	lds	r21, 0x3F05	; 0x803f05 <__malloc_margin+0x1>
- dbc:	24 1b       	sub	r18, r20
- dbe:	35 0b       	sbc	r19, r21
- dc0:	e0 91 86 3f 	lds	r30, 0x3F86	; 0x803f86 <__brkval>
- dc4:	f0 91 87 3f 	lds	r31, 0x3F87	; 0x803f87 <__brkval+0x1>
- dc8:	e2 17       	cp	r30, r18
- dca:	f3 07       	cpc	r31, r19
- dcc:	a0 f4       	brcc	.+40     	; 0xdf6 <malloc+0x120>
- dce:	2e 1b       	sub	r18, r30
- dd0:	3f 0b       	sbc	r19, r31
- dd2:	28 17       	cp	r18, r24
- dd4:	39 07       	cpc	r19, r25
- dd6:	78 f0       	brcs	.+30     	; 0xdf6 <malloc+0x120>
- dd8:	ac 01       	movw	r20, r24
- dda:	4e 5f       	subi	r20, 0xFE	; 254
- ddc:	5f 4f       	sbci	r21, 0xFF	; 255
- dde:	24 17       	cp	r18, r20
- de0:	35 07       	cpc	r19, r21
- de2:	48 f0       	brcs	.+18     	; 0xdf6 <malloc+0x120>
- de4:	4e 0f       	add	r20, r30
- de6:	5f 1f       	adc	r21, r31
- de8:	40 93 86 3f 	sts	0x3F86, r20	; 0x803f86 <__brkval>
- dec:	50 93 87 3f 	sts	0x3F87, r21	; 0x803f87 <__brkval+0x1>
- df0:	81 93       	st	Z+, r24
- df2:	91 93       	st	Z+, r25
- df4:	02 c0       	rjmp	.+4      	; 0xdfa <malloc+0x124>
- df6:	e0 e0       	ldi	r30, 0x00	; 0
- df8:	f0 e0       	ldi	r31, 0x00	; 0
- dfa:	cf 01       	movw	r24, r30
- dfc:	df 91       	pop	r29
- dfe:	cf 91       	pop	r28
- e00:	1f 91       	pop	r17
- e02:	0f 91       	pop	r16
- e04:	08 95       	ret
+00000d24 <malloc>:
+ d24:	0f 93       	push	r16
+ d26:	1f 93       	push	r17
+ d28:	cf 93       	push	r28
+ d2a:	df 93       	push	r29
+ d2c:	82 30       	cpi	r24, 0x02	; 2
+ d2e:	91 05       	cpc	r25, r1
+ d30:	10 f4       	brcc	.+4      	; 0xd36 <malloc+0x12>
+ d32:	82 e0       	ldi	r24, 0x02	; 2
+ d34:	90 e0       	ldi	r25, 0x00	; 0
+ d36:	e0 91 87 3f 	lds	r30, 0x3F87	; 0x803f87 <__flp>
+ d3a:	f0 91 88 3f 	lds	r31, 0x3F88	; 0x803f88 <__flp+0x1>
+ d3e:	20 e0       	ldi	r18, 0x00	; 0
+ d40:	30 e0       	ldi	r19, 0x00	; 0
+ d42:	a0 e0       	ldi	r26, 0x00	; 0
+ d44:	b0 e0       	ldi	r27, 0x00	; 0
+ d46:	30 97       	sbiw	r30, 0x00	; 0
+ d48:	19 f1       	breq	.+70     	; 0xd90 <malloc+0x6c>
+ d4a:	40 81       	ld	r20, Z
+ d4c:	51 81       	ldd	r21, Z+1	; 0x01
+ d4e:	02 81       	ldd	r16, Z+2	; 0x02
+ d50:	13 81       	ldd	r17, Z+3	; 0x03
+ d52:	48 17       	cp	r20, r24
+ d54:	59 07       	cpc	r21, r25
+ d56:	c8 f0       	brcs	.+50     	; 0xd8a <malloc+0x66>
+ d58:	84 17       	cp	r24, r20
+ d5a:	95 07       	cpc	r25, r21
+ d5c:	69 f4       	brne	.+26     	; 0xd78 <malloc+0x54>
+ d5e:	10 97       	sbiw	r26, 0x00	; 0
+ d60:	31 f0       	breq	.+12     	; 0xd6e <malloc+0x4a>
+ d62:	12 96       	adiw	r26, 0x02	; 2
+ d64:	0c 93       	st	X, r16
+ d66:	12 97       	sbiw	r26, 0x02	; 2
+ d68:	13 96       	adiw	r26, 0x03	; 3
+ d6a:	1c 93       	st	X, r17
+ d6c:	27 c0       	rjmp	.+78     	; 0xdbc <malloc+0x98>
+ d6e:	00 93 87 3f 	sts	0x3F87, r16	; 0x803f87 <__flp>
+ d72:	10 93 88 3f 	sts	0x3F88, r17	; 0x803f88 <__flp+0x1>
+ d76:	22 c0       	rjmp	.+68     	; 0xdbc <malloc+0x98>
+ d78:	21 15       	cp	r18, r1
+ d7a:	31 05       	cpc	r19, r1
+ d7c:	19 f0       	breq	.+6      	; 0xd84 <malloc+0x60>
+ d7e:	42 17       	cp	r20, r18
+ d80:	53 07       	cpc	r21, r19
+ d82:	18 f4       	brcc	.+6      	; 0xd8a <malloc+0x66>
+ d84:	9a 01       	movw	r18, r20
+ d86:	bd 01       	movw	r22, r26
+ d88:	ef 01       	movw	r28, r30
+ d8a:	df 01       	movw	r26, r30
+ d8c:	f8 01       	movw	r30, r16
+ d8e:	db cf       	rjmp	.-74     	; 0xd46 <malloc+0x22>
+ d90:	21 15       	cp	r18, r1
+ d92:	31 05       	cpc	r19, r1
+ d94:	f9 f0       	breq	.+62     	; 0xdd4 <malloc+0xb0>
+ d96:	28 1b       	sub	r18, r24
+ d98:	39 0b       	sbc	r19, r25
+ d9a:	24 30       	cpi	r18, 0x04	; 4
+ d9c:	31 05       	cpc	r19, r1
+ d9e:	80 f4       	brcc	.+32     	; 0xdc0 <malloc+0x9c>
+ da0:	8a 81       	ldd	r24, Y+2	; 0x02
+ da2:	9b 81       	ldd	r25, Y+3	; 0x03
+ da4:	61 15       	cp	r22, r1
+ da6:	71 05       	cpc	r23, r1
+ da8:	21 f0       	breq	.+8      	; 0xdb2 <malloc+0x8e>
+ daa:	fb 01       	movw	r30, r22
+ dac:	82 83       	std	Z+2, r24	; 0x02
+ dae:	93 83       	std	Z+3, r25	; 0x03
+ db0:	04 c0       	rjmp	.+8      	; 0xdba <malloc+0x96>
+ db2:	80 93 87 3f 	sts	0x3F87, r24	; 0x803f87 <__flp>
+ db6:	90 93 88 3f 	sts	0x3F88, r25	; 0x803f88 <__flp+0x1>
+ dba:	fe 01       	movw	r30, r28
+ dbc:	32 96       	adiw	r30, 0x02	; 2
+ dbe:	44 c0       	rjmp	.+136    	; 0xe48 <malloc+0x124>
+ dc0:	fe 01       	movw	r30, r28
+ dc2:	e2 0f       	add	r30, r18
+ dc4:	f3 1f       	adc	r31, r19
+ dc6:	81 93       	st	Z+, r24
+ dc8:	91 93       	st	Z+, r25
+ dca:	22 50       	subi	r18, 0x02	; 2
+ dcc:	31 09       	sbc	r19, r1
+ dce:	28 83       	st	Y, r18
+ dd0:	39 83       	std	Y+1, r19	; 0x01
+ dd2:	3a c0       	rjmp	.+116    	; 0xe48 <malloc+0x124>
+ dd4:	20 91 85 3f 	lds	r18, 0x3F85	; 0x803f85 <__brkval>
+ dd8:	30 91 86 3f 	lds	r19, 0x3F86	; 0x803f86 <__brkval+0x1>
+ ddc:	23 2b       	or	r18, r19
+ dde:	41 f4       	brne	.+16     	; 0xdf0 <malloc+0xcc>
+ de0:	20 91 02 3f 	lds	r18, 0x3F02	; 0x803f02 <__malloc_heap_start>
+ de4:	30 91 03 3f 	lds	r19, 0x3F03	; 0x803f03 <__malloc_heap_start+0x1>
+ de8:	20 93 85 3f 	sts	0x3F85, r18	; 0x803f85 <__brkval>
+ dec:	30 93 86 3f 	sts	0x3F86, r19	; 0x803f86 <__brkval+0x1>
+ df0:	20 91 00 3f 	lds	r18, 0x3F00	; 0x803f00 <__DATA_REGION_ORIGIN__>
+ df4:	30 91 01 3f 	lds	r19, 0x3F01	; 0x803f01 <__DATA_REGION_ORIGIN__+0x1>
+ df8:	21 15       	cp	r18, r1
+ dfa:	31 05       	cpc	r19, r1
+ dfc:	41 f4       	brne	.+16     	; 0xe0e <malloc+0xea>
+ dfe:	2d b7       	in	r18, 0x3d	; 61
+ e00:	3e b7       	in	r19, 0x3e	; 62
+ e02:	40 91 04 3f 	lds	r20, 0x3F04	; 0x803f04 <__malloc_margin>
+ e06:	50 91 05 3f 	lds	r21, 0x3F05	; 0x803f05 <__malloc_margin+0x1>
+ e0a:	24 1b       	sub	r18, r20
+ e0c:	35 0b       	sbc	r19, r21
+ e0e:	e0 91 85 3f 	lds	r30, 0x3F85	; 0x803f85 <__brkval>
+ e12:	f0 91 86 3f 	lds	r31, 0x3F86	; 0x803f86 <__brkval+0x1>
+ e16:	e2 17       	cp	r30, r18
+ e18:	f3 07       	cpc	r31, r19
+ e1a:	a0 f4       	brcc	.+40     	; 0xe44 <malloc+0x120>
+ e1c:	2e 1b       	sub	r18, r30
+ e1e:	3f 0b       	sbc	r19, r31
+ e20:	28 17       	cp	r18, r24
+ e22:	39 07       	cpc	r19, r25
+ e24:	78 f0       	brcs	.+30     	; 0xe44 <malloc+0x120>
+ e26:	ac 01       	movw	r20, r24
+ e28:	4e 5f       	subi	r20, 0xFE	; 254
+ e2a:	5f 4f       	sbci	r21, 0xFF	; 255
+ e2c:	24 17       	cp	r18, r20
+ e2e:	35 07       	cpc	r19, r21
+ e30:	48 f0       	brcs	.+18     	; 0xe44 <malloc+0x120>
+ e32:	4e 0f       	add	r20, r30
+ e34:	5f 1f       	adc	r21, r31
+ e36:	40 93 85 3f 	sts	0x3F85, r20	; 0x803f85 <__brkval>
+ e3a:	50 93 86 3f 	sts	0x3F86, r21	; 0x803f86 <__brkval+0x1>
+ e3e:	81 93       	st	Z+, r24
+ e40:	91 93       	st	Z+, r25
+ e42:	02 c0       	rjmp	.+4      	; 0xe48 <malloc+0x124>
+ e44:	e0 e0       	ldi	r30, 0x00	; 0
+ e46:	f0 e0       	ldi	r31, 0x00	; 0
+ e48:	cf 01       	movw	r24, r30
+ e4a:	df 91       	pop	r29
+ e4c:	cf 91       	pop	r28
+ e4e:	1f 91       	pop	r17
+ e50:	0f 91       	pop	r16
+ e52:	08 95       	ret
 
-00000e06 <free>:
- e06:	cf 93       	push	r28
- e08:	df 93       	push	r29
- e0a:	00 97       	sbiw	r24, 0x00	; 0
- e0c:	09 f4       	brne	.+2      	; 0xe10 <free+0xa>
- e0e:	81 c0       	rjmp	.+258    	; 0xf12 <free+0x10c>
- e10:	fc 01       	movw	r30, r24
- e12:	32 97       	sbiw	r30, 0x02	; 2
- e14:	12 82       	std	Z+2, r1	; 0x02
- e16:	13 82       	std	Z+3, r1	; 0x03
- e18:	a0 91 88 3f 	lds	r26, 0x3F88	; 0x803f88 <__flp>
- e1c:	b0 91 89 3f 	lds	r27, 0x3F89	; 0x803f89 <__flp+0x1>
- e20:	10 97       	sbiw	r26, 0x00	; 0
- e22:	81 f4       	brne	.+32     	; 0xe44 <free+0x3e>
- e24:	20 81       	ld	r18, Z
- e26:	31 81       	ldd	r19, Z+1	; 0x01
- e28:	82 0f       	add	r24, r18
- e2a:	93 1f       	adc	r25, r19
- e2c:	20 91 86 3f 	lds	r18, 0x3F86	; 0x803f86 <__brkval>
- e30:	30 91 87 3f 	lds	r19, 0x3F87	; 0x803f87 <__brkval+0x1>
- e34:	28 17       	cp	r18, r24
- e36:	39 07       	cpc	r19, r25
- e38:	51 f5       	brne	.+84     	; 0xe8e <free+0x88>
- e3a:	e0 93 86 3f 	sts	0x3F86, r30	; 0x803f86 <__brkval>
- e3e:	f0 93 87 3f 	sts	0x3F87, r31	; 0x803f87 <__brkval+0x1>
- e42:	67 c0       	rjmp	.+206    	; 0xf12 <free+0x10c>
- e44:	ed 01       	movw	r28, r26
- e46:	20 e0       	ldi	r18, 0x00	; 0
- e48:	30 e0       	ldi	r19, 0x00	; 0
- e4a:	ce 17       	cp	r28, r30
- e4c:	df 07       	cpc	r29, r31
- e4e:	40 f4       	brcc	.+16     	; 0xe60 <free+0x5a>
- e50:	4a 81       	ldd	r20, Y+2	; 0x02
- e52:	5b 81       	ldd	r21, Y+3	; 0x03
- e54:	9e 01       	movw	r18, r28
- e56:	41 15       	cp	r20, r1
- e58:	51 05       	cpc	r21, r1
- e5a:	f1 f0       	breq	.+60     	; 0xe98 <free+0x92>
- e5c:	ea 01       	movw	r28, r20
- e5e:	f5 cf       	rjmp	.-22     	; 0xe4a <free+0x44>
- e60:	c2 83       	std	Z+2, r28	; 0x02
- e62:	d3 83       	std	Z+3, r29	; 0x03
- e64:	40 81       	ld	r20, Z
- e66:	51 81       	ldd	r21, Z+1	; 0x01
- e68:	84 0f       	add	r24, r20
- e6a:	95 1f       	adc	r25, r21
- e6c:	c8 17       	cp	r28, r24
- e6e:	d9 07       	cpc	r29, r25
- e70:	59 f4       	brne	.+22     	; 0xe88 <free+0x82>
- e72:	88 81       	ld	r24, Y
- e74:	99 81       	ldd	r25, Y+1	; 0x01
- e76:	84 0f       	add	r24, r20
- e78:	95 1f       	adc	r25, r21
- e7a:	02 96       	adiw	r24, 0x02	; 2
- e7c:	80 83       	st	Z, r24
- e7e:	91 83       	std	Z+1, r25	; 0x01
- e80:	8a 81       	ldd	r24, Y+2	; 0x02
- e82:	9b 81       	ldd	r25, Y+3	; 0x03
- e84:	82 83       	std	Z+2, r24	; 0x02
- e86:	93 83       	std	Z+3, r25	; 0x03
- e88:	21 15       	cp	r18, r1
- e8a:	31 05       	cpc	r19, r1
- e8c:	29 f4       	brne	.+10     	; 0xe98 <free+0x92>
- e8e:	e0 93 88 3f 	sts	0x3F88, r30	; 0x803f88 <__flp>
- e92:	f0 93 89 3f 	sts	0x3F89, r31	; 0x803f89 <__flp+0x1>
- e96:	3d c0       	rjmp	.+122    	; 0xf12 <free+0x10c>
- e98:	e9 01       	movw	r28, r18
- e9a:	ea 83       	std	Y+2, r30	; 0x02
- e9c:	fb 83       	std	Y+3, r31	; 0x03
- e9e:	49 91       	ld	r20, Y+
- ea0:	59 91       	ld	r21, Y+
- ea2:	c4 0f       	add	r28, r20
- ea4:	d5 1f       	adc	r29, r21
- ea6:	ec 17       	cp	r30, r28
- ea8:	fd 07       	cpc	r31, r29
- eaa:	61 f4       	brne	.+24     	; 0xec4 <free+0xbe>
- eac:	80 81       	ld	r24, Z
- eae:	91 81       	ldd	r25, Z+1	; 0x01
- eb0:	84 0f       	add	r24, r20
- eb2:	95 1f       	adc	r25, r21
- eb4:	02 96       	adiw	r24, 0x02	; 2
- eb6:	e9 01       	movw	r28, r18
- eb8:	88 83       	st	Y, r24
- eba:	99 83       	std	Y+1, r25	; 0x01
- ebc:	82 81       	ldd	r24, Z+2	; 0x02
- ebe:	93 81       	ldd	r25, Z+3	; 0x03
- ec0:	8a 83       	std	Y+2, r24	; 0x02
- ec2:	9b 83       	std	Y+3, r25	; 0x03
- ec4:	e0 e0       	ldi	r30, 0x00	; 0
- ec6:	f0 e0       	ldi	r31, 0x00	; 0
- ec8:	12 96       	adiw	r26, 0x02	; 2
- eca:	8d 91       	ld	r24, X+
- ecc:	9c 91       	ld	r25, X
- ece:	13 97       	sbiw	r26, 0x03	; 3
- ed0:	00 97       	sbiw	r24, 0x00	; 0
- ed2:	19 f0       	breq	.+6      	; 0xeda <free+0xd4>
- ed4:	fd 01       	movw	r30, r26
- ed6:	dc 01       	movw	r26, r24
- ed8:	f7 cf       	rjmp	.-18     	; 0xec8 <free+0xc2>
- eda:	8d 91       	ld	r24, X+
- edc:	9c 91       	ld	r25, X
- ede:	11 97       	sbiw	r26, 0x01	; 1
- ee0:	9d 01       	movw	r18, r26
- ee2:	2e 5f       	subi	r18, 0xFE	; 254
- ee4:	3f 4f       	sbci	r19, 0xFF	; 255
- ee6:	82 0f       	add	r24, r18
- ee8:	93 1f       	adc	r25, r19
- eea:	20 91 86 3f 	lds	r18, 0x3F86	; 0x803f86 <__brkval>
- eee:	30 91 87 3f 	lds	r19, 0x3F87	; 0x803f87 <__brkval+0x1>
- ef2:	28 17       	cp	r18, r24
- ef4:	39 07       	cpc	r19, r25
- ef6:	69 f4       	brne	.+26     	; 0xf12 <free+0x10c>
- ef8:	30 97       	sbiw	r30, 0x00	; 0
- efa:	29 f4       	brne	.+10     	; 0xf06 <free+0x100>
- efc:	10 92 88 3f 	sts	0x3F88, r1	; 0x803f88 <__flp>
- f00:	10 92 89 3f 	sts	0x3F89, r1	; 0x803f89 <__flp+0x1>
- f04:	02 c0       	rjmp	.+4      	; 0xf0a <free+0x104>
- f06:	12 82       	std	Z+2, r1	; 0x02
- f08:	13 82       	std	Z+3, r1	; 0x03
- f0a:	a0 93 86 3f 	sts	0x3F86, r26	; 0x803f86 <__brkval>
- f0e:	b0 93 87 3f 	sts	0x3F87, r27	; 0x803f87 <__brkval+0x1>
- f12:	df 91       	pop	r29
- f14:	cf 91       	pop	r28
- f16:	08 95       	ret
+00000e54 <free>:
+ e54:	cf 93       	push	r28
+ e56:	df 93       	push	r29
+ e58:	00 97       	sbiw	r24, 0x00	; 0
+ e5a:	09 f4       	brne	.+2      	; 0xe5e <free+0xa>
+ e5c:	81 c0       	rjmp	.+258    	; 0xf60 <free+0x10c>
+ e5e:	fc 01       	movw	r30, r24
+ e60:	32 97       	sbiw	r30, 0x02	; 2
+ e62:	12 82       	std	Z+2, r1	; 0x02
+ e64:	13 82       	std	Z+3, r1	; 0x03
+ e66:	a0 91 87 3f 	lds	r26, 0x3F87	; 0x803f87 <__flp>
+ e6a:	b0 91 88 3f 	lds	r27, 0x3F88	; 0x803f88 <__flp+0x1>
+ e6e:	10 97       	sbiw	r26, 0x00	; 0
+ e70:	81 f4       	brne	.+32     	; 0xe92 <free+0x3e>
+ e72:	20 81       	ld	r18, Z
+ e74:	31 81       	ldd	r19, Z+1	; 0x01
+ e76:	82 0f       	add	r24, r18
+ e78:	93 1f       	adc	r25, r19
+ e7a:	20 91 85 3f 	lds	r18, 0x3F85	; 0x803f85 <__brkval>
+ e7e:	30 91 86 3f 	lds	r19, 0x3F86	; 0x803f86 <__brkval+0x1>
+ e82:	28 17       	cp	r18, r24
+ e84:	39 07       	cpc	r19, r25
+ e86:	51 f5       	brne	.+84     	; 0xedc <free+0x88>
+ e88:	e0 93 85 3f 	sts	0x3F85, r30	; 0x803f85 <__brkval>
+ e8c:	f0 93 86 3f 	sts	0x3F86, r31	; 0x803f86 <__brkval+0x1>
+ e90:	67 c0       	rjmp	.+206    	; 0xf60 <free+0x10c>
+ e92:	ed 01       	movw	r28, r26
+ e94:	20 e0       	ldi	r18, 0x00	; 0
+ e96:	30 e0       	ldi	r19, 0x00	; 0
+ e98:	ce 17       	cp	r28, r30
+ e9a:	df 07       	cpc	r29, r31
+ e9c:	40 f4       	brcc	.+16     	; 0xeae <free+0x5a>
+ e9e:	4a 81       	ldd	r20, Y+2	; 0x02
+ ea0:	5b 81       	ldd	r21, Y+3	; 0x03
+ ea2:	9e 01       	movw	r18, r28
+ ea4:	41 15       	cp	r20, r1
+ ea6:	51 05       	cpc	r21, r1
+ ea8:	f1 f0       	breq	.+60     	; 0xee6 <free+0x92>
+ eaa:	ea 01       	movw	r28, r20
+ eac:	f5 cf       	rjmp	.-22     	; 0xe98 <free+0x44>
+ eae:	c2 83       	std	Z+2, r28	; 0x02
+ eb0:	d3 83       	std	Z+3, r29	; 0x03
+ eb2:	40 81       	ld	r20, Z
+ eb4:	51 81       	ldd	r21, Z+1	; 0x01
+ eb6:	84 0f       	add	r24, r20
+ eb8:	95 1f       	adc	r25, r21
+ eba:	c8 17       	cp	r28, r24
+ ebc:	d9 07       	cpc	r29, r25
+ ebe:	59 f4       	brne	.+22     	; 0xed6 <free+0x82>
+ ec0:	88 81       	ld	r24, Y
+ ec2:	99 81       	ldd	r25, Y+1	; 0x01
+ ec4:	84 0f       	add	r24, r20
+ ec6:	95 1f       	adc	r25, r21
+ ec8:	02 96       	adiw	r24, 0x02	; 2
+ eca:	80 83       	st	Z, r24
+ ecc:	91 83       	std	Z+1, r25	; 0x01
+ ece:	8a 81       	ldd	r24, Y+2	; 0x02
+ ed0:	9b 81       	ldd	r25, Y+3	; 0x03
+ ed2:	82 83       	std	Z+2, r24	; 0x02
+ ed4:	93 83       	std	Z+3, r25	; 0x03
+ ed6:	21 15       	cp	r18, r1
+ ed8:	31 05       	cpc	r19, r1
+ eda:	29 f4       	brne	.+10     	; 0xee6 <free+0x92>
+ edc:	e0 93 87 3f 	sts	0x3F87, r30	; 0x803f87 <__flp>
+ ee0:	f0 93 88 3f 	sts	0x3F88, r31	; 0x803f88 <__flp+0x1>
+ ee4:	3d c0       	rjmp	.+122    	; 0xf60 <free+0x10c>
+ ee6:	e9 01       	movw	r28, r18
+ ee8:	ea 83       	std	Y+2, r30	; 0x02
+ eea:	fb 83       	std	Y+3, r31	; 0x03
+ eec:	49 91       	ld	r20, Y+
+ eee:	59 91       	ld	r21, Y+
+ ef0:	c4 0f       	add	r28, r20
+ ef2:	d5 1f       	adc	r29, r21
+ ef4:	ec 17       	cp	r30, r28
+ ef6:	fd 07       	cpc	r31, r29
+ ef8:	61 f4       	brne	.+24     	; 0xf12 <free+0xbe>
+ efa:	80 81       	ld	r24, Z
+ efc:	91 81       	ldd	r25, Z+1	; 0x01
+ efe:	84 0f       	add	r24, r20
+ f00:	95 1f       	adc	r25, r21
+ f02:	02 96       	adiw	r24, 0x02	; 2
+ f04:	e9 01       	movw	r28, r18
+ f06:	88 83       	st	Y, r24
+ f08:	99 83       	std	Y+1, r25	; 0x01
+ f0a:	82 81       	ldd	r24, Z+2	; 0x02
+ f0c:	93 81       	ldd	r25, Z+3	; 0x03
+ f0e:	8a 83       	std	Y+2, r24	; 0x02
+ f10:	9b 83       	std	Y+3, r25	; 0x03
+ f12:	e0 e0       	ldi	r30, 0x00	; 0
+ f14:	f0 e0       	ldi	r31, 0x00	; 0
+ f16:	12 96       	adiw	r26, 0x02	; 2
+ f18:	8d 91       	ld	r24, X+
+ f1a:	9c 91       	ld	r25, X
+ f1c:	13 97       	sbiw	r26, 0x03	; 3
+ f1e:	00 97       	sbiw	r24, 0x00	; 0
+ f20:	19 f0       	breq	.+6      	; 0xf28 <free+0xd4>
+ f22:	fd 01       	movw	r30, r26
+ f24:	dc 01       	movw	r26, r24
+ f26:	f7 cf       	rjmp	.-18     	; 0xf16 <free+0xc2>
+ f28:	8d 91       	ld	r24, X+
+ f2a:	9c 91       	ld	r25, X
+ f2c:	11 97       	sbiw	r26, 0x01	; 1
+ f2e:	9d 01       	movw	r18, r26
+ f30:	2e 5f       	subi	r18, 0xFE	; 254
+ f32:	3f 4f       	sbci	r19, 0xFF	; 255
+ f34:	82 0f       	add	r24, r18
+ f36:	93 1f       	adc	r25, r19
+ f38:	20 91 85 3f 	lds	r18, 0x3F85	; 0x803f85 <__brkval>
+ f3c:	30 91 86 3f 	lds	r19, 0x3F86	; 0x803f86 <__brkval+0x1>
+ f40:	28 17       	cp	r18, r24
+ f42:	39 07       	cpc	r19, r25
+ f44:	69 f4       	brne	.+26     	; 0xf60 <free+0x10c>
+ f46:	30 97       	sbiw	r30, 0x00	; 0
+ f48:	29 f4       	brne	.+10     	; 0xf54 <free+0x100>
+ f4a:	10 92 87 3f 	sts	0x3F87, r1	; 0x803f87 <__flp>
+ f4e:	10 92 88 3f 	sts	0x3F88, r1	; 0x803f88 <__flp+0x1>
+ f52:	02 c0       	rjmp	.+4      	; 0xf58 <free+0x104>
+ f54:	12 82       	std	Z+2, r1	; 0x02
+ f56:	13 82       	std	Z+3, r1	; 0x03
+ f58:	a0 93 85 3f 	sts	0x3F85, r26	; 0x803f85 <__brkval>
+ f5c:	b0 93 86 3f 	sts	0x3F86, r27	; 0x803f86 <__brkval+0x1>
+ f60:	df 91       	pop	r29
+ f62:	cf 91       	pop	r28
+ f64:	08 95       	ret
 
-00000f18 <memcpy>:
- f18:	fb 01       	movw	r30, r22
- f1a:	dc 01       	movw	r26, r24
- f1c:	02 c0       	rjmp	.+4      	; 0xf22 <memcpy+0xa>
- f1e:	01 90       	ld	r0, Z+
- f20:	0d 92       	st	X+, r0
- f22:	41 50       	subi	r20, 0x01	; 1
- f24:	50 40       	sbci	r21, 0x00	; 0
- f26:	d8 f7       	brcc	.-10     	; 0xf1e <memcpy+0x6>
- f28:	08 95       	ret
+00000f66 <memcpy>:
+ f66:	fb 01       	movw	r30, r22
+ f68:	dc 01       	movw	r26, r24
+ f6a:	02 c0       	rjmp	.+4      	; 0xf70 <memcpy+0xa>
+ f6c:	01 90       	ld	r0, Z+
+ f6e:	0d 92       	st	X+, r0
+ f70:	41 50       	subi	r20, 0x01	; 1
+ f72:	50 40       	sbci	r21, 0x00	; 0
+ f74:	d8 f7       	brcc	.-10     	; 0xf6c <memcpy+0x6>
+ f76:	08 95       	ret
 
-00000f2a <eeprom_read_byte>:
- f2a:	03 d0       	rcall	.+6      	; 0xf32 <eeprom_mapen>
- f2c:	80 81       	ld	r24, Z
- f2e:	99 27       	eor	r25, r25
- f30:	08 95       	ret
+00000f78 <eeprom_read_byte>:
+ f78:	03 d0       	rcall	.+6      	; 0xf80 <eeprom_mapen>
+ f7a:	80 81       	ld	r24, Z
+ f7c:	99 27       	eor	r25, r25
+ f7e:	08 95       	ret
 
-00000f32 <eeprom_mapen>:
- f32:	fc 01       	movw	r30, r24
- f34:	e0 50       	subi	r30, 0x00	; 0
- f36:	fc 4e       	sbci	r31, 0xEC	; 236
- f38:	08 95       	ret
+00000f80 <eeprom_mapen>:
+ f80:	fc 01       	movw	r30, r24
+ f82:	e0 50       	subi	r30, 0x00	; 0
+ f84:	fc 4e       	sbci	r31, 0xEC	; 236
+ f86:	08 95       	ret
 
-00000f3a <eeprom_write_byte>:
- f3a:	26 2f       	mov	r18, r22
+00000f88 <eeprom_write_byte>:
+ f88:	26 2f       	mov	r18, r22
 
-00000f3c <eeprom_write_r18>:
- f3c:	af 93       	push	r26
- f3e:	bf 93       	push	r27
- f40:	e0 e0       	ldi	r30, 0x00	; 0
- f42:	f0 e1       	ldi	r31, 0x10	; 16
- f44:	32 81       	ldd	r19, Z+2	; 0x02
- f46:	31 fd       	sbrc	r19, 1
- f48:	fd cf       	rjmp	.-6      	; 0xf44 <eeprom_write_r18+0x8>
- f4a:	dc 01       	movw	r26, r24
- f4c:	a0 50       	subi	r26, 0x00	; 0
- f4e:	bc 4e       	sbci	r27, 0xEC	; 236
- f50:	2c 93       	st	X, r18
- f52:	2d e9       	ldi	r18, 0x9D	; 157
- f54:	24 bf       	out	0x34, r18	; 52
- f56:	23 e0       	ldi	r18, 0x03	; 3
- f58:	20 83       	st	Z, r18
- f5a:	01 96       	adiw	r24, 0x01	; 1
- f5c:	bf 91       	pop	r27
- f5e:	af 91       	pop	r26
- f60:	08 95       	ret
+00000f8a <eeprom_write_r18>:
+ f8a:	af 93       	push	r26
+ f8c:	bf 93       	push	r27
+ f8e:	e0 e0       	ldi	r30, 0x00	; 0
+ f90:	f0 e1       	ldi	r31, 0x10	; 16
+ f92:	32 81       	ldd	r19, Z+2	; 0x02
+ f94:	31 fd       	sbrc	r19, 1
+ f96:	fd cf       	rjmp	.-6      	; 0xf92 <eeprom_write_r18+0x8>
+ f98:	dc 01       	movw	r26, r24
+ f9a:	a0 50       	subi	r26, 0x00	; 0
+ f9c:	bc 4e       	sbci	r27, 0xEC	; 236
+ f9e:	2c 93       	st	X, r18
+ fa0:	2d e9       	ldi	r18, 0x9D	; 157
+ fa2:	24 bf       	out	0x34, r18	; 52
+ fa4:	23 e0       	ldi	r18, 0x03	; 3
+ fa6:	20 83       	st	Z, r18
+ fa8:	01 96       	adiw	r24, 0x01	; 1
+ faa:	bf 91       	pop	r27
+ fac:	af 91       	pop	r26
+ fae:	08 95       	ret
 
-00000f62 <_exit>:
- f62:	f8 94       	cli
+00000fb0 <_exit>:
+ fb0:	f8 94       	cli
 
-00000f64 <__stop_program>:
- f64:	ff cf       	rjmp	.-2      	; 0xf64 <__stop_program>
+00000fb2 <__stop_program>:
+ fb2:	ff cf       	rjmp	.-2      	; 0xfb2 <__stop_program>
diff --git a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.map b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.map
index f975b14..97ea7c7 100644
--- a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.map
+++ b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.map
@@ -1,31 +1,36 @@
 Archive member included to satisfy reference by file (symbol)
 
-e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
-                              E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o (exit)
-e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+                              C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o (exit)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
                               avr_uart_driver/avr_uart.o (__do_clear_bss)
-e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
                               si5351_driver/si5351_driver.o (malloc)
-e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
                               si5351_driver/si5351_driver.o (memcpy)
-E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(puts.o)
+                              cm_task_manager/cm_task_manager.o (puts)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(iob.o)
+                              c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(puts.o) (__iob)
+C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
                               avr_eeprom_driver/avr_eeprom_driver.o (eeprom_read_byte)
-E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
                               avr_eeprom_driver/avr_eeprom_driver.o (eeprom_write_byte)
-e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
-                              e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o) (__do_copy_data)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+                              c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o) (__do_copy_data)
 
 Allocating common symbols
 Common symbol       size              file
 
-storno_xtal_app     0x40              main.o
-__brkval            0x2               e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
-__flp               0x2               e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+storno_xtal_app     0x3f              main.o
+__brkval            0x2               c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+__flp               0x2               c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+__iob               0x6               c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(iob.o)
 
 Discarded input sections
 
- .data          0x00000000        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
- .bss           0x00000000        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .data          0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .bss           0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
  .text          0x00000000        0x0 avr_eeprom_driver/avr_eeprom_driver.o
  .data          0x00000000        0x0 avr_eeprom_driver/avr_eeprom_driver.o
  .bss           0x00000000        0x0 avr_eeprom_driver/avr_eeprom_driver.o
@@ -55,11 +60,34 @@ Discarded input sections
  .text          0x00000000        0x0 cm_msg/cm_msg.o
  .data          0x00000000        0x0 cm_msg/cm_msg.o
  .bss           0x00000000        0x0 cm_msg/cm_msg.o
+ .text          0x00000000        0x0 cm_task_manager/cm_task_manager.o
+ .data          0x00000000        0x0 cm_task_manager/cm_task_manager.o
+ .bss           0x00000000        0x0 cm_task_manager/cm_task_manager.o
+ .text.cm_taskManager_blockDelay_ms
+                0x00000000       0x5a cm_task_manager/cm_task_manager.o
+ .rodata.str1.1
+                0x00000000       0x56 cm_task_manager/cm_task_manager.o
+ .text.cm_taskManager_addTaskToList
+                0x00000000       0x68 cm_task_manager/cm_task_manager.o
+ .text.cm_taskManager_deleteTaskFromList
+                0x00000000       0x78 cm_task_manager/cm_task_manager.o
+ .text.cm_taskManager_run_tasks
+                0x00000000       0x66 cm_task_manager/cm_task_manager.o
+ .text.cm_taskManager_init
+                0x00000000        0xc cm_task_manager/cm_task_manager.o
+ .debug_info    0x00000000      0x321 cm_task_manager/cm_task_manager.o
+ .debug_abbrev  0x00000000      0x179 cm_task_manager/cm_task_manager.o
+ .debug_loc     0x00000000      0x2e3 cm_task_manager/cm_task_manager.o
+ .debug_aranges
+                0x00000000       0x40 cm_task_manager/cm_task_manager.o
+ .debug_ranges  0x00000000       0x30 cm_task_manager/cm_task_manager.o
+ .debug_line    0x00000000      0x20e cm_task_manager/cm_task_manager.o
+ .debug_str     0x00000000      0x2f0 cm_task_manager/cm_task_manager.o
+ .comment       0x00000000       0x31 cm_task_manager/cm_task_manager.o
+ .debug_frame   0x00000000       0x90 cm_task_manager/cm_task_manager.o
  .text          0x00000000        0x0 cqm6xx_app.o
  .data          0x00000000        0x0 cqm6xx_app.o
  .bss           0x00000000        0x0 cqm6xx_app.o
- .text.programPLL_Parameters
-                0x00000000       0x5e cqm6xx_app.o
  .text          0x00000000        0x0 main.o
  .data          0x00000000        0x0 main.o
  .bss           0x00000000        0x0 main.o
@@ -70,65 +98,76 @@ Discarded input sections
                 0x00000000       0xf4 si5351_driver/si5351_driver.o
  .text.cm_si5351_getRevisionNumber
                 0x00000000       0x68 si5351_driver/si5351_driver.o
- .text          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
- .data          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
- .bss           0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
  .text.libgcc.mul
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
  .text.libgcc.div
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
- .text.libgcc   0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+ .text.libgcc   0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
  .text.libgcc.prologue
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
  .text.libgcc.builtins
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
  .text.libgcc.fmul
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
  .text.libgcc.fixed
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
- .text          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
- .data          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
- .bss           0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
  .text.libgcc.mul
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
  .text.libgcc.div
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
- .text.libgcc   0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+ .text.libgcc   0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
  .text.libgcc.prologue
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
  .text.libgcc.builtins
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
  .text.libgcc.fmul
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
  .text.libgcc.fixed
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
- .text          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
- .bss           0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
- .text          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
- .data          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
- .bss           0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
- .text          0x00000000        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
- .data          0x00000000        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
- .bss           0x00000000        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
- .text          0x00000000        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
- .data          0x00000000        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
- .bss           0x00000000        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
- .text          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
- .data          0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
- .bss           0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(puts.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(puts.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(puts.o)
+ .text.avr-libc
+                0x00000000       0x60 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(puts.o)
+ .comment       0x00000000       0x31 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(puts.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(iob.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(iob.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(iob.o)
+ .comment       0x00000000       0x31 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(iob.o)
+ COMMON         0x00000000        0x6 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(iob.o)
+ .text          0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+ .data          0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+ .bss           0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+ .text          0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+ .data          0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+ .bss           0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
  .text.libgcc.mul
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
  .text.libgcc.div
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
- .text.libgcc   0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+ .text.libgcc   0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
  .text.libgcc.prologue
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
  .text.libgcc.builtins
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
  .text.libgcc.fmul
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
  .text.libgcc.fixed
-                0x00000000        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
 
 Memory Configuration
 
@@ -146,23 +185,24 @@ Linker script and memory map
 
 Address of section .data set to 0x803f00
                 0x00008000                __RODATA_PM_OFFSET__ = 0x8000
-LOAD E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+LOAD C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
 LOAD avr_eeprom_driver/avr_eeprom_driver.o
 LOAD avr_gpio_driver/avr_gpio.o
 LOAD avr_i2c_driver/avr_i2c.o
 LOAD avr_uart_driver/avr_uart.o
 LOAD cm_msg/cm_msg.o
+LOAD cm_task_manager/cm_task_manager.o
 LOAD cqm6xx_app.o
 LOAD main.o
 LOAD si5351_driver/si5351_driver.o
 START GROUP
-LOAD e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libm.a
+LOAD c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libm.a
 END GROUP
 START GROUP
-LOAD e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a
-LOAD e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libm.a
-LOAD e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a
-LOAD E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a
+LOAD c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a
+LOAD c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libm.a
+LOAD c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a
+LOAD C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a
 END GROUP
                 [0x00000000]                __TEXT_REGION_ORIGIN__ = DEFINED (__TEXT_REGION_ORIGIN__)?__TEXT_REGION_ORIGIN__:0x0
                 [0x00803f00]                __DATA_REGION_ORIGIN__ = DEFINED (__DATA_REGION_ORIGIN__)?__DATA_REGION_ORIGIN__:0x802000
@@ -265,9 +305,9 @@ END GROUP
 .rela.plt
  *(.rela.plt)
 
-.text           0x00000000      0xf66
+.text           0x00000000      0xfb4
  *(.vectors)
- .vectors       0x00000000       0x34 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .vectors       0x00000000       0x34 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
                 0x00000000                __vector_default
                 0x00000000                __vectors
  *(.vectors)
@@ -295,20 +335,20 @@ END GROUP
  SORT(*)(.ctors)
  SORT(*)(.dtors)
  *(.init0)
- .init0         0x00000034        0x0 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .init0         0x00000034        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
                 0x00000034                __init
  *(.init0)
  *(.init1)
  *(.init1)
  *(.init2)
- .init2         0x00000034        0xc E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .init2         0x00000034        0xc C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
  *(.init2)
  *(.init3)
  *(.init3)
  *(.init4)
- .init4         0x00000040       0x10 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
+ .init4         0x00000040       0x10 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_clear_bss.o)
                 0x00000040                __do_clear_bss
- .init4         0x00000050       0x16 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
+ .init4         0x00000050       0x16 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_copy_data.o)
                 0x00000050                __do_copy_data
  *(.init4)
  *(.init5)
@@ -320,10 +360,10 @@ END GROUP
  *(.init8)
  *(.init8)
  *(.init9)
- .init9         0x00000066        0x4 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .init9         0x00000066        0x4 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
  *(.init9)
  *(.text)
- .text          0x0000006a        0x2 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .text          0x0000006a        0x2 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
                 0x0000006a                __vector_1
                 0x0000006a                __vector_24
                 0x0000006a                __vector_12
@@ -396,64 +436,70 @@ END GROUP
  .text.cm_MsgCompleteEvt_Register
                 0x0000054c       0x1c cm_msg/cm_msg.o
                 0x0000054c                cm_MsgCompleteEvt_Register
- .text.cqm6xx_app_updateOsc
-                0x00000568       0x4e cqm6xx_app.o
  .text.cqm_setPLLParam
-                0x000005b6       0x7a cqm6xx_app.o
+                0x00000568       0x7a cqm6xx_app.o
+ .text.cqm6xx_app_loadPLLParam
+                0x000005e2       0x62 cqm6xx_app.o
  .text.uart_rx_event
-                0x00000630       0x36 cqm6xx_app.o
-                0x00000630                uart_rx_event
- .text.cqm6xx_app_statemachine
-                0x00000666       0xb8 cqm6xx_app.o
-                0x00000666                cqm6xx_app_statemachine
+                0x00000644       0x44 cqm6xx_app.o
+                0x00000644                uart_rx_event
+ .text.setRTXOscMode
+                0x00000688       0x3c cqm6xx_app.o
+                0x00000688                setRTXOscMode
+ .text.EepromWritePLLParameters
+                0x000006c4       0x54 cqm6xx_app.o
+                0x000006c4                EepromWritePLLParameters
+ .text.cqm6xx_app_taskHandler
+                0x00000718       0x52 cqm6xx_app.o
+                0x00000718                cqm6xx_app_taskHandler
  .text.cqm6xx_app_init
-                0x0000071e      0x12a cqm6xx_app.o
-                0x0000071e                cqm6xx_app_init
- .text.main     0x00000848       0x44 main.o
-                0x00000848                main
+                0x0000076a      0x12c cqm6xx_app.o
+                0x0000076a                cqm6xx_app_init
+ .text.main     0x00000896       0x44 main.o
+                0x00000896                main
  .text.writeRegister
-                0x0000088c       0x78 si5351_driver/si5351_driver.o
+                0x000008da       0x78 si5351_driver/si5351_driver.o
  .text.cm_setOutputMultiSynthRaw
-                0x00000904       0xac si5351_driver/si5351_driver.o
-                0x00000904                cm_setOutputMultiSynthRaw
+                0x00000952       0xac si5351_driver/si5351_driver.o
+                0x00000952                cm_setOutputMultiSynthRaw
  .text.cm_setOutputEnable
-                0x000009b0       0x4e si5351_driver/si5351_driver.o
-                0x000009b0                cm_setOutputEnable
+                0x000009fe       0x4e si5351_driver/si5351_driver.o
+                0x000009fe                cm_setOutputEnable
  .text.cm_setCLKControl
-                0x000009fe       0x68 si5351_driver/si5351_driver.o
-                0x000009fe                cm_setCLKControl
+                0x00000a4c       0x68 si5351_driver/si5351_driver.o
+                0x00000a4c                cm_setCLKControl
  .text.cm_setInputSource
-                0x00000a66       0x3e si5351_driver/si5351_driver.o
-                0x00000a66                cm_setInputSource
+                0x00000ab4       0x3e si5351_driver/si5351_driver.o
+                0x00000ab4                cm_setInputSource
  .text.cm_resetPLLs
-                0x00000aa4       0x44 si5351_driver/si5351_driver.o
-                0x00000aa4                cm_resetPLLs
+                0x00000af2       0x44 si5351_driver/si5351_driver.o
+                0x00000af2                cm_resetPLLs
  .text.cm_setPllParamRaw
-                0x00000ae8       0x94 si5351_driver/si5351_driver.o
-                0x00000ae8                cm_setPllParamRaw
+                0x00000b36       0x94 si5351_driver/si5351_driver.o
+                0x00000b36                cm_setPllParamRaw
  .text.cm_si5351_init
-                0x00000b7c      0x15a si5351_driver/si5351_driver.o
-                0x00000b7c                cm_si5351_init
+                0x00000bca      0x15a si5351_driver/si5351_driver.o
+                0x00000bca                cm_si5351_init
  .text.avr-libc
-                0x00000cd6      0x242 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
-                0x00000cd6                malloc
-                0x00000e06                free
+                0x00000d24      0x242 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+                0x00000d24                malloc
+                0x00000e54                free
  .text.avr-libc
-                0x00000f18       0x12 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
-                0x00000f18                memcpy
+                0x00000f66       0x12 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(memcpy.o)
+                0x00000f66                memcpy
  .text.avr-libc
-                0x00000f2a       0x10 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
-                0x00000f2a                eeprom_read_byte
-                0x00000f32                eeprom_mapen
+                0x00000f78       0x10 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+                0x00000f78                eeprom_read_byte
+                0x00000f80                eeprom_mapen
  .text.avr-libc
-                0x00000f3a       0x28 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
-                0x00000f3a                eeprom_write_byte
-                0x00000f3c                eeprom_write_r18
-                0x00000f62                . = ALIGN (0x2)
+                0x00000f88       0x28 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+                0x00000f88                eeprom_write_byte
+                0x00000f8a                eeprom_write_r18
+                0x00000fb0                . = ALIGN (0x2)
  *(.fini9)
- .fini9         0x00000f62        0x0 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
-                0x00000f62                _exit
-                0x00000f62                exit
+ .fini9         0x00000fb0        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+                0x00000fb0                _exit
+                0x00000fb0                exit
  *(.fini9)
  *(.fini8)
  *(.fini8)
@@ -472,19 +518,19 @@ END GROUP
  *(.fini1)
  *(.fini1)
  *(.fini0)
- .fini0         0x00000f62        0x4 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
+ .fini0         0x00000fb0        0x4 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avrxmega3/short-calls\libgcc.a(_exit.o)
  *(.fini0)
-                0x00000f66                _etext = .
+                0x00000fb4                _etext = .
 
 .rodata
  *(.rodata)
  *(.rodata*)
  *(.gnu.linkonce.r*)
 
-.data           0x00803f00        0x6 load address 0x00000f66
+.data           0x00803f00        0x6 load address 0x00000fb4
                 0x00803f00                PROVIDE (__data_start, .)
  *(.data)
- .data          0x00803f00        0x6 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+ .data          0x00803f00        0x6 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
                 0x00803f00                __malloc_heap_end
                 0x00803f02                __malloc_heap_start
                 0x00803f04                __malloc_margin
@@ -494,7 +540,7 @@ END GROUP
                 0x00803f06                _edata = .
                 0x00803f06                PROVIDE (__data_end, .)
 
-.bss            0x00803f06       0x84
+.bss            0x00803f06       0x83
                 0x00803f06                PROVIDE (__bss_start, .)
  *(.bss)
  *(.bss*)
@@ -515,21 +561,21 @@ END GROUP
                 0x00803f44        0x2 cm_msg/cm_msg.o
                 0x00803f44                s_msg_cmplete_evt_fpt
  *(COMMON)
- COMMON         0x00803f46       0x40 main.o
+ COMMON         0x00803f46       0x3f main.o
                 0x00803f46                storno_xtal_app
- COMMON         0x00803f86        0x4 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
-                0x00803f86                __brkval
-                0x00803f88                __flp
-                0x00803f8a                PROVIDE (__bss_end, .)
-                0x00000f66                __data_load_start = LOADADDR (.data)
-                0x00000f6c                __data_load_end = (__data_load_start + SIZEOF (.data))
+ COMMON         0x00803f85        0x4 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+                0x00803f85                __brkval
+                0x00803f87                __flp
+                0x00803f89                PROVIDE (__bss_end, .)
+                0x00000fb4                __data_load_start = LOADADDR (.data)
+                0x00000fba                __data_load_end = (__data_load_start + SIZEOF (.data))
 
-.noinit         0x00803f8a        0x0
+.noinit         0x00803f89        0x0
                 [!provide]                PROVIDE (__noinit_start, .)
  *(.noinit*)
                 [!provide]                PROVIDE (__noinit_end, .)
-                0x00803f8a                _end = .
-                0x00803f8a                PROVIDE (__heap_start, .)
+                0x00803f89                _end = .
+                0x00803f89                PROVIDE (__heap_start, .)
 
 .eeprom         0x00810000        0x0
  *(.eeprom*)
@@ -579,12 +625,12 @@ END GROUP
  .comment       0x00000030       0x31 cqm6xx_app.o
  .comment       0x00000030       0x31 main.o
  .comment       0x00000030       0x31 si5351_driver/si5351_driver.o
- .comment       0x00000030       0x31 e:/cm_programs/microchip_studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
+ .comment       0x00000030       0x31 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avrxmega3/short-calls\libc.a(malloc.o)
 
 .note.gnu.avr.deviceinfo
                 0x00000000       0x3c
  .note.gnu.avr.deviceinfo
-                0x00000000       0x3c E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+                0x00000000       0x3c C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
 
 .note.gnu.build-id
  *(.note.gnu.build-id)
@@ -601,7 +647,7 @@ END GROUP
 .debug_sfnames
  *(.debug_sfnames)
 
-.debug_aranges  0x00000000      0x238
+.debug_aranges  0x00000000      0x240
  *(.debug_aranges)
  .debug_aranges
                 0x00000000       0x28 avr_eeprom_driver/avr_eeprom_driver.o
@@ -614,102 +660,102 @@ END GROUP
  .debug_aranges
                 0x000000f8       0x30 cm_msg/cm_msg.o
  .debug_aranges
-                0x00000128       0x48 cqm6xx_app.o
+                0x00000128       0x50 cqm6xx_app.o
  .debug_aranges
-                0x00000170       0x20 main.o
+                0x00000178       0x20 main.o
  .debug_aranges
-                0x00000190       0x68 si5351_driver/si5351_driver.o
+                0x00000198       0x68 si5351_driver/si5351_driver.o
  .debug_aranges
-                0x000001f8       0x20 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+                0x00000200       0x20 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
  .debug_aranges
-                0x00000218       0x20 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+                0x00000220       0x20 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
 
 .debug_pubnames
  *(.debug_pubnames)
 
-.debug_info     0x00000000     0x4ff6
+.debug_info     0x00000000     0x4fdf
  *(.debug_info .gnu.linkonce.wi.*)
- .debug_info    0x00000000     0x11d6 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .debug_info    0x00000000     0x11d6 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
  .debug_info    0x000011d6      0x183 avr_eeprom_driver/avr_eeprom_driver.o
  .debug_info    0x00001359      0x320 avr_gpio_driver/avr_gpio.o
  .debug_info    0x00001679      0x6c8 avr_i2c_driver/avr_i2c.o
  .debug_info    0x00001d41      0x519 avr_uart_driver/avr_uart.o
  .debug_info    0x0000225a      0x2b4 cm_msg/cm_msg.o
- .debug_info    0x0000250e      0x9bd cqm6xx_app.o
- .debug_info    0x00002ecb      0xb13 main.o
- .debug_info    0x000039de     0x14be si5351_driver/si5351_driver.o
- .debug_info    0x00004e9c       0xad E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
- .debug_info    0x00004f49       0xad E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+ .debug_info    0x0000250e      0x9ba cqm6xx_app.o
+ .debug_info    0x00002ec8      0xaff main.o
+ .debug_info    0x000039c7     0x14be si5351_driver/si5351_driver.o
+ .debug_info    0x00004e85       0xad C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+ .debug_info    0x00004f32       0xad C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
 
-.debug_abbrev   0x00000000     0x1d79
+.debug_abbrev   0x00000000     0x1d48
  *(.debug_abbrev)
- .debug_abbrev  0x00000000     0x10de E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .debug_abbrev  0x00000000     0x10de C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
  .debug_abbrev  0x000010de       0xac avr_eeprom_driver/avr_eeprom_driver.o
  .debug_abbrev  0x0000118a      0x107 avr_gpio_driver/avr_gpio.o
  .debug_abbrev  0x00001291      0x1b6 avr_i2c_driver/avr_i2c.o
  .debug_abbrev  0x00001447      0x1e2 avr_uart_driver/avr_uart.o
  .debug_abbrev  0x00001629      0x15a cm_msg/cm_msg.o
- .debug_abbrev  0x00001783      0x213 cqm6xx_app.o
- .debug_abbrev  0x00001996      0x169 main.o
- .debug_abbrev  0x00001aff      0x252 si5351_driver/si5351_driver.o
- .debug_abbrev  0x00001d51       0x14 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
- .debug_abbrev  0x00001d65       0x14 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+ .debug_abbrev  0x00001783      0x1e2 cqm6xx_app.o
+ .debug_abbrev  0x00001965      0x169 main.o
+ .debug_abbrev  0x00001ace      0x252 si5351_driver/si5351_driver.o
+ .debug_abbrev  0x00001d20       0x14 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+ .debug_abbrev  0x00001d34       0x14 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
 
-.debug_line     0x00000000     0x1678
+.debug_line     0x00000000     0x1696
  *(.debug_line .debug_line.* .debug_line_end)
- .debug_line    0x00000000      0x136 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
- .debug_line    0x00000136      0x166 avr_eeprom_driver/avr_eeprom_driver.o
- .debug_line    0x0000029c      0x18e avr_gpio_driver/avr_gpio.o
- .debug_line    0x0000042a      0x441 avr_i2c_driver/avr_i2c.o
- .debug_line    0x0000086b      0x223 avr_uart_driver/avr_uart.o
- .debug_line    0x00000a8e      0x216 cm_msg/cm_msg.o
- .debug_line    0x00000ca4      0x377 cqm6xx_app.o
- .debug_line    0x0000101b      0x110 main.o
- .debug_line    0x0000112b      0x40d si5351_driver/si5351_driver.o
- .debug_line    0x00001538       0x7c E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
- .debug_line    0x000015b4       0xc4 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
+ .debug_line    0x00000000      0x136 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .debug_line    0x00000136      0x16e avr_eeprom_driver/avr_eeprom_driver.o
+ .debug_line    0x000002a4      0x196 avr_gpio_driver/avr_gpio.o
+ .debug_line    0x0000043a      0x449 avr_i2c_driver/avr_i2c.o
+ .debug_line    0x00000883      0x22b avr_uart_driver/avr_uart.o
+ .debug_line    0x00000aae      0x21a cm_msg/cm_msg.o
+ .debug_line    0x00000cc8      0x369 cqm6xx_app.o
+ .debug_line    0x00001031      0x114 main.o
+ .debug_line    0x00001145      0x411 si5351_driver/si5351_driver.o
+ .debug_line    0x00001556       0x7c C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eerd_byte.o)
+ .debug_line    0x000015d2       0xc4 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls\libattiny402.a(eewr_byte.o)
 
-.debug_frame    0x00000000      0x5d8
+.debug_frame    0x00000000      0x5f4
  *(.debug_frame)
  .debug_frame   0x00000000       0x74 avr_eeprom_driver/avr_eeprom_driver.o
  .debug_frame   0x00000074       0x44 avr_gpio_driver/avr_gpio.o
  .debug_frame   0x000000b8      0x108 avr_i2c_driver/avr_i2c.o
  .debug_frame   0x000001c0       0xcc avr_uart_driver/avr_uart.o
  .debug_frame   0x0000028c       0x44 cm_msg/cm_msg.o
- .debug_frame   0x000002d0       0xec cqm6xx_app.o
- .debug_frame   0x000003bc       0x34 main.o
- .debug_frame   0x000003f0      0x1e8 si5351_driver/si5351_driver.o
+ .debug_frame   0x000002d0      0x108 cqm6xx_app.o
+ .debug_frame   0x000003d8       0x34 main.o
+ .debug_frame   0x0000040c      0x1e8 si5351_driver/si5351_driver.o
 
-.debug_str      0x00000000     0x2145
+.debug_str      0x00000000     0x2120
  *(.debug_str)
- .debug_str     0x00000000      0x7a9 E:/cm_programs/microchip_studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
- .debug_str     0x000007a9      0x1d2 avr_eeprom_driver/avr_eeprom_driver.o
-                                0x218 (size before relaxing)
- .debug_str     0x0000097b      0x16e avr_gpio_driver/avr_gpio.o
-                                0x312 (size before relaxing)
- .debug_str     0x00000ae9      0x2ab avr_i2c_driver/avr_i2c.o
-                                0x4ff (size before relaxing)
- .debug_str     0x00000d94      0x283 avr_uart_driver/avr_uart.o
-                                0x4f1 (size before relaxing)
- .debug_str     0x00001017      0x23a cm_msg/cm_msg.o
-                                0x3f7 (size before relaxing)
- .debug_str     0x00001251      0x401 cqm6xx_app.o
-                                0x664 (size before relaxing)
- .debug_str     0x00001652      0x787 main.o
-                                0xae1 (size before relaxing)
- .debug_str     0x00001dd9      0x36c si5351_driver/si5351_driver.o
-                                0xe51 (size before relaxing)
+ .debug_str     0x00000000      0x7a9 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/atmel/ATtiny_DFP/1.10.348/gcc/dev/attiny402/avrxmega3/short-calls/crtattiny402.o
+ .debug_str     0x000007a9      0x1d9 avr_eeprom_driver/avr_eeprom_driver.o
+                                0x21f (size before relaxing)
+ .debug_str     0x00000982      0x16e avr_gpio_driver/avr_gpio.o
+                                0x319 (size before relaxing)
+ .debug_str     0x00000af0      0x2ab avr_i2c_driver/avr_i2c.o
+                                0x506 (size before relaxing)
+ .debug_str     0x00000d9b      0x283 avr_uart_driver/avr_uart.o
+                                0x4f8 (size before relaxing)
+ .debug_str     0x0000101e      0x23a cm_msg/cm_msg.o
+                                0x3fe (size before relaxing)
+ .debug_str     0x00001258      0x3d5 cqm6xx_app.o
+                                0x63f (size before relaxing)
+ .debug_str     0x0000162d      0x787 main.o
+                                0xac0 (size before relaxing)
+ .debug_str     0x00001db4      0x36c si5351_driver/si5351_driver.o
+                                0xe58 (size before relaxing)
 
-.debug_loc      0x00000000     0x1f43
+.debug_loc      0x00000000     0x1fe7
  *(.debug_loc)
  .debug_loc     0x00000000      0x24b avr_eeprom_driver/avr_eeprom_driver.o
  .debug_loc     0x0000024b       0xae avr_gpio_driver/avr_gpio.o
  .debug_loc     0x000002f9      0x70d avr_i2c_driver/avr_i2c.o
  .debug_loc     0x00000a06      0x16e avr_uart_driver/avr_uart.o
  .debug_loc     0x00000b74      0x179 cm_msg/cm_msg.o
- .debug_loc     0x00000ced      0x4a9 cqm6xx_app.o
- .debug_loc     0x00001196       0x47 main.o
- .debug_loc     0x000011dd      0xd66 si5351_driver/si5351_driver.o
+ .debug_loc     0x00000ced      0x54d cqm6xx_app.o
+ .debug_loc     0x0000123a       0x47 main.o
+ .debug_loc     0x00001281      0xd66 si5351_driver/si5351_driver.o
 
 .debug_macinfo
  *(.debug_macinfo)
@@ -729,16 +775,16 @@ END GROUP
 .debug_pubtypes
  *(.debug_pubtypes)
 
-.debug_ranges   0x00000000      0x1c0
+.debug_ranges   0x00000000      0x1c8
  *(.debug_ranges)
  .debug_ranges  0x00000000       0x18 avr_eeprom_driver/avr_eeprom_driver.o
  .debug_ranges  0x00000018       0x20 avr_gpio_driver/avr_gpio.o
  .debug_ranges  0x00000038       0x50 avr_i2c_driver/avr_i2c.o
  .debug_ranges  0x00000088       0x30 avr_uart_driver/avr_uart.o
  .debug_ranges  0x000000b8       0x20 cm_msg/cm_msg.o
- .debug_ranges  0x000000d8       0x68 cqm6xx_app.o
- .debug_ranges  0x00000140       0x10 main.o
- .debug_ranges  0x00000150       0x70 si5351_driver/si5351_driver.o
+ .debug_ranges  0x000000d8       0x70 cqm6xx_app.o
+ .debug_ranges  0x00000148       0x10 main.o
+ .debug_ranges  0x00000158       0x70 si5351_driver/si5351_driver.o
 
 .debug_macro
  *(.debug_macro)
diff --git a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.srec b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.srec
index 160bdac..7076d22 100644
--- a/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.srec
+++ b/storno_cqp6xx_digital_xtal/Debug/storno_cqp6xx_digital_xtal.srec
@@ -3,16 +3,16 @@ S113000019C033C032C031C030C02FC02EC02DC083
 S11300102CC02BC02AC029C028C027C026C025C098
 S113002024C023C022C021C020C01FC094C11DC051
 S11300301CC01BC011241FBECFEFCDBFDFE3DEBF4A
-S11300402FE3A6E0BFE301C01D92AA38B207E1F78F
-S11300501FE3A0E0BFE3E6E6FFE002C005900D92D7
-S1130060A630B107D9F7F0D37CC7CACFEF92FF927D
+S11300402FE3A6E0BFE301C01D92A938B207E1F790
+S11300501FE3A0E0BFE3E4EBFFE002C005900D92D4
+S1130060A630B107D9F717D4A3C7CACFEF92FF922E
 S11300700F931F93CF93DF934423A1F08B01C82FD9
 S1130080D92F4150E42EF12C8FEFE81AF80AE60E2E
-S1130090F71EF80161918F01CE014FD721960E15FD
+S1130090F71EF80161918F01CE0176D721960E15D6
 S11300A01F05B9F7DF91CF911F910F91FF90EF904A
 S11300B00895EF92FF920F931F93CF93DF934423FE
 S11300C0A1F0C82FD92F8B014150E42EF12C8FEFD2
-S11300D0E81AF80AE60EF71ECE0127D7F801819335
+S11300D0E81AF80AE60EF71ECE014ED7F80181930E
 S11300E08F012196EE15FF05B9F7DF91CF911F918E
 S11300F00F91FF90EF90089581110BC08091080437
 S113010090E002C0959587956A95E2F781709927EA
@@ -85,166 +85,171 @@ S11305209091083F891778F0E091443FF091453F5E
 S11305306BE07FE38091423F9091433F0995109295
 S1130540403F10923F3F80E090E00895009759F0BB
 S11305506115710541F08093423F9093433F60934E
-S1130560443F7093453F0895CF93DF93FC0182810C
-S113057093810097E9F03097D9F0218130812317D6
-S1130580B9F0EF01213019F0223051F011C040E0F0
-S113059060E00ED241E061E08A819B8109D208C00B
-S11305A041E060E005D240E061E08A819B8100D2B5
-S11305B0DF91CF9108959F92AF92BF92CF92DF9235
-S11305C0EF92FF920F931F93CF93DF93EC01942E3E
-S11305D0AD84BE84CF84D888E984FA840B851C85D5
-S11305E02D813E814F8158858A819B817DD2A98C42
-S11305F0BA8CCB8CDC8CED88FE880F89188D298908
-S11306003A894B895C89692D8A819B817BD140E041
-S1130610692D8A819B81F3D1DF91CF911F910F9135
-S1130620FF90EF90DF90CF90BF90AF909F90089590
-S1130630FB012081222319F0213051F011C0DC018B
-S113064014968EE1FB0101900D928A95E1F708C0A2
-S1130650DC0192968EE1FB0101900D928A95E1F7FF
-S113066080E090E008950F931F93CF93DF93FC01F4
-S113067022813381232B09F44DC0009709F44AC029
-S1130680EC018181813079F118F08230C1F142C0EE
-S113069010828F010C5F1F4F4EE1B80180E090E0A3
-S11306A008DD60E08A819B81DED140E060E0CE011C
-S11306B082DF4EE1B80180E290E0FBDC41E061E0E2
-S11306C0CE0179DF42E061E0CE0175DF40E062E017
-S11306D08A819B8194D140E062E08A819B8168D1C8
-S11306E081E0898317C0CF013FDF8981888363E07C
-S11306F080E002DD019771F482E089830BC0CF01B1
-S113070033DF8981888363E080E0F6DC892B11F490
-S113071081E08983DF91CF911F910F9108950F9309
-S11307201F93CF93DF936115710509F488C0009777
-S113073009F485C0EC01198218826A837B8368E11D
-S113074073E004DF62E572E0CE013CDE8E010E5DF3
-S11307501F4F4EE1B80180E090E0ABDC8AA18150EC
-S11307608E3F08F066C06BC0919191509E3F08F493
-S113077066C02E173F07C1F783E49DE0A0E0B0E018
-S11307808D839E83AF83B8878BA39CA3ADA3BEA3A5
-S113079086EF9CE2A0E0B0E089879A87AB87BC87AC
-S11307A08FA398A7A9A7BAA78BE598E4A0E1B0E026
-S11307B08D879E87AF87B88B8BA79CA7ADA7BEA755
-S11307C082E190E0A0E0B0E0898B9A8BAB8BBC8B8C
-S11307D08FA798ABA9ABBAAB1D8A1E8A1F8A188E45
-S11307E01BAA1CAA1DAA1EAA81E090E0A0E0B0E00A
-S11307F0898F9A8FAB8FBC8F8FAB98AFA9AFBAAFED
-S113080080E498E7ADE7B1E08E8F9F8FA8A3B9A3EA
-S11308108CAF9DAFAEAFBFAFBE016C5F7F4F4EE1FB
-S113082080E090E023DC4EE1B80180E290E01EDC41
-S113083006C0FE01B3969E01205C3F4F95CFDF9129
-S1130840CF911F910F910895CF93DF93CDB7DEB76A
-S1130850A297CDBFDEBF80E090E02BDD40E660E0F4
-S113086070E0CE0101963FDD41E951E0BE016F5FCA
-S11308707F4FCE01049682D1BE016C5F7F4F86E428
-S11308809FE34DDF86E49FE3EEDEFCCF8F929F92E1
-S1130890AF92BF92CF92DF92EF92FF920F931F938A
-S11308A0CF93DF93EC01862E5A0168017901C801C8
-S11308B0019611D2982E192FFC018192CF01A60125
-S11308C0B5012AD3A70196012F5F3F4F4F4F5F4FCA
-S11308D0EA81FB8101E0692D712F88819981099555
-S11308E0892D912F90D280E090E0DF91CF911F91DC
-S11308F00F91FF90EF90DF90CF90BF90AF909F90BB
-S11309008F900895AF92BF92CF92DF92EF92FF92B1
-S11309100F931F93FC01437056895078378B208FB7
-S1130920F28EE38ED601C501072E7CE0B695A7951D
-S1130930979587957A95D1F7702D83708295807FEE
-S11309400370802B818FB48AA58A452B468B613036
-S113095079F018F06230B9F020C0AF014C5E5F4FFF
-S113096008E010E020E030E06AE2CF018FDF15C03C
-S1130970AF014C5E5F4F08E010E020E030E062E33E
-S1130980CF0184DF0AC0AF014C5E5F4F08E010E086
-S113099020E030E06AE3CF0179DF80E090E01F914E
-S11309A00F91FF90EF90DF90CF90BF90AF9008959C
-S11309B00F931F93613051F018F0623069F011C049
-S11309C0FC01278140FB20F927830BC0FC01278110
-S11309D040FB21F9278305C0FC01278140FB22F954
-S11309E02783AC01495F5F4F01E010E020E030E075
-S11309F063E04CDF80E090E01F910F9108950F9326
-S1130A001F93FC01928540FB97F990799F6492872C
-S1130A10613079F018F06230B9F020C0AF01465F60
-S1130A205F4F01E010E020E030E060E1CF012EDF15
-S1130A3015C0AF01465F5F4F01E010E020E030E0F9
-S1130A4061E1CF0123DF0AC0AF01465F5F4F01E0E0
-S1130A5010E020E030E062E1CF0118DF80E090E0B8
-S1130A601F910F9108950F931F93662319F061301E
-S1130A7039F00AC0FC0121852B7F277F218704C020
-S1130A80FC01218524602187AC01475F5F4F01E0B1
-S1130A9010E020E030E060EFF9DE80E090E01F91AC
-S1130AA00F9108950F931F9331E0611101C030E05D
-S1130AB0FC01268D30FB25F9268F31E0411101C060
-S1130AC030E0FC01268D30FB27F9268FAC01425E15
-S1130AD05F4F01E010E020E030E061EBD7DE80E022
-S1130AE090E01F910F910895AF92BF92CF92DF9241
-S1130AF0EF92FF920F931F93CF93DF93EC01427019
-S1130B008E858C7F482B4E873F87288BD801C70161
-S1130B1088279927AF70BB27FA8AEB8A8A2F8F70B0
-S1130B20898BBC86AD86662319F0613061F015C0EF
-S1130B3008E010E020E030E0AE01445F5F4F6AE17E
-S1130B40CE01A4DE0AC008E010E020E030E0AE01EF
-S1130B50445F5F4F62E2CE0199DE41E061E0CE0185
-S1130B60A1DF80E090E0DF91CF911F910F91FF9082
-S1130B70EF90DF90CF90BF90AF900895EF92FF92E7
-S1130B800F931F93CF93DF931F92CDB7DEB70097D8
-S1130B9009F491C06115710509F490C0411551051E
-S1130BA009F48FC07C01DC016D937C93119712963C
-S1130BB04D935C931397FC0134968BE1DF011D92F6
-S1130BC08A95E9F78FEF898301E010E020E030E0B7
-S1130BD0AE014F5F5F4F63E0C70158DE80E8898351
-S1130BE001E010E020E030E0AE014F5F5F4F60E1D4
-S1130BF0C7014CDE01E010E020E030E0AE014F5FC1
-S1130C005F4F61E1C70142DE01E010E020E030E027
-S1130C10AE014F5F5F4F62E1C70138DE01E010E0D3
-S1130C2020E030E0AE014F5F5F4F63E1C7012EDE8D
-S1130C3001E010E020E030E0AE014F5F5F4F64E17F
-S1130C40C70124DE01E010E020E030E0AE014F5F98
-S1130C505F4F65E1C7011ADE01E010E020E030E0FB
-S1130C60AE014F5F5F4F66E1C70110DE01E010E0A7
-S1130C7020E030E0AE014F5F5F4F67E1C70106DE61
-S1130C8080EC898301E010E020E030E0AE014F5FAA
-S1130C905F4F67EBC701FADD80E4898301E010E070
-S1130CA020E030E0AE014F5F5F4F6BEBC701EEDD3C
-S1130CB080E090E008C08FEF9FEF05C08FEF9FEFBB
-S1130CC002C08FEF9FEF0F90DF91CF911F910F9193
-S1130CD0FF90EF9008950F931F93CF93DF9382308B
-S1130CE0910510F482E090E0E091883FF091893F13
-S1130CF020E030E0A0E0B0E0309719F1408151816C
-S1130D000281138148175907C8F08417950769F4BD
-S1130D10109731F012960C93129713961C9327C0D8
-S1130D200093883F1093893F22C02115310519F0A3
-S1130D304217530718F49A01BD01EF01DF01F801CE
-S1130D40DBCF21153105F9F0281B390B243031058F
-S1130D5080F48A819B816115710521F0FB018283F6
-S1130D60938304C08093883F9093893FFE01329619
-S1130D7044C0FE01E20FF31F819391932250310985
-S1130D80288339833AC02091863F3091873F232BB3
-S1130D9041F42091023F3091033F2093863F3093EA
-S1130DA0873F2091003F3091013F2115310541F4E7
-S1130DB02DB73EB74091043F5091053F241B350B9E
-S1130DC0E091863FF091873FE217F307A0F42E1BD2
-S1130DD03F0B2817390778F0AC014E5F5F4F24179B
-S1130DE0350748F04E0F5F1F4093863F5093873F6F
-S1130DF08193919302C0E0E0F0E0CF01DF91CF91C5
-S1130E001F910F910895CF93DF93009709F481C048
-S1130E10FC01329712821382A091883FB091893FDE
-S1130E20109781F420813181820F931F2091863F96
-S1130E303091873F2817390751F5E093863FF093A7
-S1130E40873F67C0ED0120E030E0CE17DF0740F4B4
-S1130E504A815B819E0141155105F1F0EA01F5CF0C
-S1130E60C283D38340815181840F951FC817D9074A
-S1130E7059F488819981840F951F02968083918308
-S1130E808A819B81828393832115310529F4E09320
-S1130E90883FF093893F3DC0E901EA83FB83499190
-S1130EA05991C40FD51FEC17FD0761F4808191811E
-S1130EB0840F951F0296E901888399838281938127
-S1130EC08A839B83E0E0F0E012968D919C911397C6
-S1130ED0009719F0FD01DC01F7CF8D919C911197DA
-S1130EE09D012E5F3F4F820F931F2091863F3091CB
-S1130EF0873F2817390769F4309729F41092883FFF
-S1130F001092893F02C012821382A093863FB0934D
-S1130F10873FDF91CF910895FB01DC0102C001906E
-S1130F200D9241505040D8F7089503D080819927FD
-S1130F300895FC01E050FC4E0895262FAF93BF9313
-S1130F40E0E0F0E1328131FDFDCFDC01A050BC4E88
-S1130F502C932DE924BF23E020830196BF91AF9108
-S1090F600895F894FFCF90
-S1090F6600008A3F200098
+S1130560443F7093453F08959F92AF92BF92CF92BC
+S1130570DF92EF92FF920F931F93CF93DF93EC01DF
+S1130580942EAC84BD84CE84DF84E884F9840A8507
+S11305901B852C813D814E815F8189819A81CBD2DB
+S11305A0A88CB98CCA8CDB8CEC88FD880E891F89D9
+S11305B0288939894A895B89692D89819A81C9D1B8
+S11305C040E0692D89819A8141D2DF91CF911F91B9
+S11305D00F91FF90EF90DF90CF90BF90AF909F90DE
+S11305E008950F931F93CF93DF93EC018C010D5F5C
+S11305F01F4F4EE1B80180E090E05BDD60E089814F
+S11306009A8158D240E060E0CE01AEDF4EE1B801FD
+S113061080E290E04EDD41E061E0CE01A5DF42E002
+S113062061E0CE01A1DF40E062E089819A810ED2CF
+S113063040E062E089819A81E2D1DF91CF911F91FC
+S11306400F910895CF93DF93EC01FB0190819923DF
+S113065019F0913051F011C08EE1FB01DE011396C7
+S113066001900D928A95E1F708C08EE1FB01DE014D
+S1130670919601900D928A95E1F782E0888380E05B
+S113068090E0DF91CF910895CF93DF93EC018881BF
+S1130690813059F040E060E089819A81B0D141E035
+S11306A061E089819A81ABD10AC041E060E089812F
+S11306B09A81A5D140E061E089819A81A0D1DF913E
+S11306C0CF910895FC012381213071F028F02E3F51
+S11306D099F02F3FC9F00895BC016D5F7F4F4EE143
+S11306E080E090E0C3DC0895BC016F5D7F4F4EE174
+S11306F080E290E0BBDC0895BC016D5F7F4F4EE16A
+S113070080E090E0D6DC0895BC016F5D7F4F4EE140
+S113071080E290E0CEDC0895CF93DF93FC01218149
+S11307203281232BF9F00097E9F0EC0180818230CB
+S113073031F41082CF01C6DFCE0153DF13C063E072
+S113074080E0DADC019739F08881882339F0188257
+S1130750CE019ADF07C08881813021F081E088834F
+S1130760CE0192DFDF91CF9108950F931F93CF9322
+S1130770DF936115710509F489C0009709F486C0F7
+S1130780EC0169837A8362E273E0E0DE62E572E0A1
+S1130790CE0118DE8E010F5D1F4F4EE1B80180E0DF
+S11307A090E087DC89A181508E3F08F069C008C0C1
+S11307B0919191509E3F20F02E173F07C9F703C037
+S11307C0CE010FDF63C083E49DE0A0E0B0E08C8342
+S11307D09D83AE83BF838AA39BA3ACA3BDA386EFF3
+S11307E09CE2A0E0B0E088879987AA87BB878EA3A4
+S11307F09FA3A8A7B9A78BE598E4A0E1B0E08C87F4
+S11308009D87AE87BF878AA79BA7ACA7BDA782E1B8
+S113081090E0A0E0B0E0888B998BAA8BBB8B8EA76D
+S11308209FA7A8ABB9AB1C8A1D8A1E8A1F8A1AAA65
+S11308301BAA1CAA1DAA81E090E0A0E0B0E0888F6A
+S1130840998FAA8FBB8F8EAB9FABA8AFB9AF80E453
+S113085098E7ADE7B1E08D8F9E8FAF8FB8A38BAFD4
+S11308609CAFADAFBEAF4EE1BE016D5F7F4F80E088
+S113087090E0FCDB4EE1B80180E290E0F7DBA0CF32
+S1130880FE01B2969E01215C3F4F92CFDF91CF9142
+S11308901F910F910895CF93DF93CDB7DEB7A29741
+S11308A0CDBFDEBF80E090E004DD40E660E070E0B4
+S11308B0CE01019618DD41E951E0BE016F5F7F4F23
+S11308C0CE01049682D1BE016C5F7F4F86E49FE324
+S11308D04CDF86E49FE320DFFCCF8F929F92AF92A0
+S11308E0BF92CF92DF92EF92FF920F931F93CF9319
+S11308F0DF93EC01862E5A0168017901C801019643
+S113090011D2982E192FFC018192CF01A601B501B5
+S11309102AD3A70196012F5F3F4F4F4F5F4FEA81C4
+S1130920FB8101E0692D712F888199810995892DB9
+S1130930912F90D280E090E0DF91CF911F910F91A1
+S1130940FF90EF90DF90CF90BF90AF909F908F90EB
+S11309500895AF92BF92CF92DF92EF92FF920F93DE
+S11309601F93FC01437056895078378B208FF28E89
+S1130970E38ED601C501072E7CE0B695A795979521
+S113098087957A95D1F7702D83708295807F037057
+S1130990802B818FB48AA58A452B468B613079F0F0
+S11309A018F06230B9F020C0AF014C5E5F4F08E030
+S11309B010E020E030E06AE2CF018FDF15C0AF0124
+S11309C04C5E5F4F08E010E020E030E062E3CF01CE
+S11309D084DF0AC0AF014C5E5F4F08E010E020E006
+S11309E030E06AE3CF0179DF80E090E01F910F915E
+S11309F0FF90EF90DF90CF90BF90AF9008950F934A
+S1130A001F93613051F018F0623069F011C0FC019D
+S1130A10278140FB20F927830BC0FC01278140FB81
+S1130A2021F9278305C0FC01278140FB22F9278394
+S1130A30AC01495F5F4F01E010E020E030E063E08B
+S1130A404CDF80E090E01F910F9108950F931F9366
+S1130A50FC01928540FB97F990799F6492876130FD
+S1130A6079F018F06230B9F020C0AF01465F5F4FF3
+S1130A7001E010E020E030E060E1CF012EDF15C09E
+S1130A80AF01465F5F4F01E010E020E030E061E13C
+S1130A90CF0123DF0AC0AF01465F5F4F01E010E0E2
+S1130AA020E030E062E1CF0118DF80E090E01F91A8
+S1130AB00F9108950F931F93662319F0613039F055
+S1130AC00AC0FC0121852B7F277F218704C0FC01FC
+S1130AD0218524602187AC01475F5F4F01E010E06E
+S1130AE020E030E060EFF9DE80E090E01F910F91AC
+S1130AF008950F931F9331E0611101C030E0FC01B0
+S1130B00268D30FB25F9268F31E0411101C030E0FC
+S1130B10FC01268D30FB27F9268FAC01425E5F4F26
+S1130B2001E010E020E030E061EBD7DE80E090E00F
+S1130B301F910F910895AF92BF92CF92DF92EF92DF
+S1130B40FF920F931F93CF93DF93EC0142708E8536
+S1130B508C7F482B4E873F87288BD801C701882775
+S1130B609927AF70BB27FA8AEB8A8A2F8F70898BFB
+S1130B70BC86AD86662319F0613061F015C008E0CB
+S1130B8010E020E030E0AE01445F5F4F6AE1CE0147
+S1130B90A4DE0AC008E010E020E030E0AE01445FCB
+S1130BA05F4F62E2CE0199DE41E061E0CE01A1DF58
+S1130BB080E090E0DF91CF911F910F91FF90EF9033
+S1130BC0DF90CF90BF90AF900895EF92FF920F9374
+S1130BD01F93CF93DF931F92CDB7DEB7009709F42D
+S1130BE091C06115710509F490C04115510509F4CE
+S1130BF08FC07C01DC016D937C93119712964D9309
+S1130C005C931397FC0134968BE1DF011D928A9566
+S1130C10E9F78FEF898301E010E020E030E0AE01D6
+S1130C204F5F5F4F63E0C70158DE80E8898301E0CE
+S1130C3010E020E030E0AE014F5F5F4F60E1C7019C
+S1130C404CDE01E010E020E030E0AE014F5F5F4F8A
+S1130C5061E1C70142DE01E010E020E030E0AE01D6
+S1130C604F5F5F4F62E1C70138DE01E010E020E032
+S1130C7030E0AE014F5F5F4F63E1C7012EDE01E05C
+S1130C8010E020E030E0AE014F5F5F4F64E1C70148
+S1130C9024DE01E010E020E030E0AE014F5F5F4F62
+S1130CA065E1C7011ADE01E010E020E030E0AE01AA
+S1130CB04F5F5F4F66E1C70110DE01E010E020E006
+S1130CC030E0AE014F5F5F4F67E1C70106DE80ECA5
+S1130CD0898301E010E020E030E0AE014F5F5F4F18
+S1130CE067EBC701FADD80E4898301E010E020E0CE
+S1130CF030E0AE014F5F5F4F6BEBC701EEDD80E08C
+S1130D0090E008C08FEF9FEF05C08FEF9FEF02C008
+S1130D108FEF9FEF0F90DF91CF911F910F91FF9075
+S1130D20EF9008950F931F93CF93DF938230910533
+S1130D3010F482E090E0E091873FF091883F20E05A
+S1130D4030E0A0E0B0E0309719F140815181028198
+S1130D50138148175907C8F08417950769F4109749
+S1130D6031F012960C93129713961C9327C000939C
+S1130D70873F1093883F22C02115310519F042178F
+S1130D80530718F49A01BD01EF01DF01F801DBCF2D
+S1130D9021153105F9F0281B390B2430310580F475
+S1130DA08A819B816115710521F0FB018283938304
+S1130DB004C08093873F9093883FFE01329644C0DD
+S1130DC0FE01E20FF31F819391932250310928838E
+S1130DD039833AC02091853F3091863F232B41F4DB
+S1130DE02091023F3091033F2093853F3093863F0B
+S1130DF02091003F3091013F2115310541F42DB779
+S1130E003EB74091043F5091053F241B350BE091C0
+S1130E10853FF091863FE217F307A0F42E1B3F0BAA
+S1130E202817390778F0AC014E5F5F4F2417350758
+S1130E3048F04E0F5F1F4093853F5093863F819348
+S1130E40919302C0E0E0F0E0CF01DF91CF911F91D8
+S1130E500F910895CF93DF93009709F481C0FC01AB
+S1130E60329712821382A091873FB091883F1097E6
+S1130E7081F420813181820F931F2091853F30912D
+S1130E80863F2817390751F5E093853FF093863F55
+S1130E9067C0ED0120E030E0CE17DF0740F44A815F
+S1130EA05B819E0141155105F1F0EA01F5CFC28342
+S1130EB0D38340815181840F951FC817D90759F4F2
+S1130EC088819981840F951F0296808391838A81FA
+S1130ED09B81828393832115310529F4E093873F15
+S1130EE0F093883F3DC0E901EA83FB83499159911E
+S1130EF0C40FD51FEC17FD0761F480819181840F25
+S1130F00951F0296E90188839983828193818A835C
+S1130F109B83E0E0F0E012968D919C9113970097EB
+S1130F2019F0FD01DC01F7CF8D919C9111979D0182
+S1130F302E5F3F4F820F931F2091853F3091863F54
+S1130F402817390769F4309729F41092873F1092D3
+S1130F50883F02C012821382A093853FB093863FDC
+S1130F60DF91CF910895FB01DC0102C001900D9245
+S1130F7041505040D8F7089503D0808199270895AF
+S1130F80FC01E050FC4E0895262FAF93BF93E0E0A0
+S1130F90F0E1328131FDFDCFDC01A050BC4E2C9339
+S1130FA02DE924BF23E020830196BF91AF910895DA
+S1070FB0F894FFCFDF
+S1090FB40000893F20004B
 S9030000FC
diff --git a/storno_cqp6xx_digital_xtal/cqm6xx_app.c b/storno_cqp6xx_digital_xtal/cqm6xx_app.c
index 8979379..836462d 100644
--- a/storno_cqp6xx_digital_xtal/cqm6xx_app.c
+++ b/storno_cqp6xx_digital_xtal/cqm6xx_app.c
@@ -5,14 +5,14 @@
  *  Author: Christian Lind Vie Madsen - OZ1CM
  */ 
 #include "cqm6xx_app.h"
-#include "string.h"
 #include "si5351_driver/si5351_driver.h"
 #include "avr_gpio_driver/avr_gpio.h"
 #include "avr_uart_driver/avr_uart.h"
 #include "avr_global_config.h"
 #include "avr_eeprom_driver/avr_eeprom_driver.h"
 #include "cm_msg/cm_msg.h"
-#include "cm_task_manager/cm_task_manager.h"
+#include <string.h>
+
 
 #define PLLA_SETTINGS_EEPROM_ADDR 0x00 // addr 0
 #define PLLB_SETTINGS_EEPROM_ADDR 0x20 // addr 32 (64 bytes total memory)
@@ -25,6 +25,44 @@ static uint8_t isStructValid(storno_xtal_app_t *inst){
 		return 0;
 } 
 
+static void cqm_setPLLParam(storno_xtal_app_t *inst, si5351_PLLs pll_num, si5351_Outputs output){
+	
+	cm_setPllParamRaw(inst->si5351_dev,pll_num, inst->plla_param_data.MSNx_P1, inst->plla_param_data.MSNx_P2, inst->plla_param_data.MSNx_P3);
+	//_delay_ms(1);
+	cm_setOutputMultiSynthRaw(inst->si5351_dev,output, inst->plla_param_data.MSx_P1, inst->plla_param_data.MSx_P2, inst->plla_param_data.MSx_P3);
+	//_delay_ms(1);
+	cm_setCLKControl(inst->si5351_dev,output,SI5351_CLK_POWER_UP);
+	
+	
+}
+static void cqm6xx_app_loadPLLParam(storno_xtal_app_t *inst){
+	
+	// Read settings for PLLA first
+	cm_EEPROM_read((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->plla_param_data,sizeof(storno_pll_param_msg));
+	//_delay_ms(1);
+	cm_setInputSource(inst->si5351_dev, SI5351_CLK_SOURCE_XTAL);
+	//_delay_ms(1);
+	
+	
+	cqm_setPLLParam(inst, SI5351_PLL_A, SI5351_OUTPUT_0);
+	//_delay_ms(1);
+	
+	
+	cm_EEPROM_read((uint8_t*)PLLB_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->plla_param_data,sizeof(storno_pll_param_msg));
+	//_delay_ms(1);
+	cqm_setPLLParam(inst, SI5351_PLL_B, SI5351_OUTPUT_1);
+	
+	
+	// Set third output to crystal freq for calibration!
+	cqm_setPLLParam(inst, SI5351_PLL_B, SI5351_OUTPUT_2);
+	cm_setCLKControl(inst->si5351_dev, SI5351_OUTPUT_2,SI5351_CLK_POWER_UP);
+	//_delay_ms(1);
+	cm_setOutputEnable(inst->si5351_dev,SI5351_OUTPUT_2,SI5351_OUTPUT_ENABLE);
+
+	
+	
+}
+
 void setRTXOscMode(storno_xtal_app_t *inst){
 	
 	if(inst->rtx_mode != STORNO_APP_TX_MODE){
@@ -39,41 +77,17 @@ void setRTXOscMode(storno_xtal_app_t *inst){
 	
 }
 
-void cqm6xx_app_taskHandler(storno_xtal_app_t *inst){
-	
-	// Check Struct
-	if(isStructValid(inst) != 0)return;
-	
-	// Run next task:
-	cm_taskManager_run_tasks(&inst->storno_xtal_task);
-	
-	// Find out if we are in RX or TX 
-	
-	// If TX pin is not set, then turn on RX output on PLL and disable TX clock. Run setRTXOscMode once, so pll isnt constantly written to!!
-	if((gpio_get_level(GPIO_PORTA,GPIO_PIN_PTT) != GPIO_LEVEL_SET) && (inst->rtx_mode != STORNO_APP_RX_MODE )){
-		
-		inst->rtx_mode = STORNO_APP_RX_MODE;
-		cm_taskManager_addTaskToList(&inst->storno_xtal_task,setRTXOscMode,inst);
-
-	}else if (inst->rtx_mode != STORNO_APP_TX_MODE){
-		inst->rtx_mode = STORNO_APP_TX_MODE;
-		cm_taskManager_addTaskToList(&inst->storno_xtal_task,setRTXOscMode,inst);
-
-	}
-	
-}
-
 void EepromWritePLLParameters(storno_xtal_app_t *inst){
 	
 	//Burn settings into eeprom here:
 	switch(inst->plla_param_data.header.PLL_Ident){
 		
 		case MSG_PLLA_PARAM:
-			cm_EEPROM_write((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t*)&(inst->plla_param_data), sizeof(storno_pll_param_msg));	
+		cm_EEPROM_write((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t*)&(inst->plla_param_data), sizeof(storno_pll_param_msg));
 		break;
 		
 		case MSG_PLLB_PARAM:
-			cm_EEPROM_write((uint8_t*)PLLB_SETTINGS_EEPROM_ADDR,(uint8_t*)&(inst->pllb_param_data), sizeof(storno_pll_param_msg));
+		cm_EEPROM_write((uint8_t*)PLLB_SETTINGS_EEPROM_ADDR,(uint8_t*)&(inst->pllb_param_data), sizeof(storno_pll_param_msg));
 		break;
 		
 		case MSG_GET_PLLA_PARAM:
@@ -92,6 +106,40 @@ void EepromWritePLLParameters(storno_xtal_app_t *inst){
 	
 }
 
+void cqm6xx_app_taskHandler(storno_xtal_app_t *inst){
+	
+	// Check Struct
+	if(isStructValid(inst) != 0)return;
+	
+	// Run next task:
+	//cm_taskManager_run_tasks(&inst->storno_xtal_task);
+	
+	// Save eeprom setting if we have to:
+	if(inst->rtx_mode == STORNO_APP_PROGRAM_EEPROM){
+		inst->rtx_mode = STORNO_APP_RX_MODE;
+		EepromWritePLLParameters(inst);
+		cqm6xx_app_loadPLLParam(inst);
+		return;
+	}
+	
+	// If TX pin is not set, then turn on RX output on PLL and disable TX clock. Run setRTXOscMode once, so pll isnt constantly written to!!
+	if((gpio_get_level(GPIO_PORTA,GPIO_PIN_PTT) != GPIO_LEVEL_SET) && (inst->rtx_mode != STORNO_APP_RX_MODE)){
+		
+		inst->rtx_mode = STORNO_APP_RX_MODE;
+		setRTXOscMode(inst);
+		//cm_taskManager_addTaskToList(&inst->storno_xtal_task,setRTXOscMode,inst);
+
+	}else if (inst->rtx_mode != STORNO_APP_TX_MODE){
+		inst->rtx_mode = STORNO_APP_TX_MODE;
+		setRTXOscMode(inst);
+		//cm_taskManager_addTaskToList(&inst->storno_xtal_task,setRTXOscMode,inst);
+
+	}
+	
+}
+
+
+
 static int writeDefaultSettingsEEprom(storno_xtal_app_t *inst){
 	
 	
@@ -130,44 +178,6 @@ static int isEEPROMValid(storno_xtal_app_t *inst){
 	return 0;
 	
 	
-}
-
-static void cqm_setPLLParam(storno_xtal_app_t *inst, si5351_PLLs pll_num, si5351_Outputs output){
-	
-	cm_setPllParamRaw(inst->si5351_dev,pll_num, inst->plla_param_data.MSNx_P1, inst->plla_param_data.MSNx_P2, inst->plla_param_data.MSNx_P3);
-	//_delay_ms(1);
-	cm_setOutputMultiSynthRaw(inst->si5351_dev,output, inst->plla_param_data.MSx_P1, inst->plla_param_data.MSx_P2, inst->plla_param_data.MSx_P3);
-	//_delay_ms(1);
-	cm_setCLKControl(inst->si5351_dev,output,SI5351_CLK_POWER_UP);
-	
-	
-}
-static void cqm6xx_app_loadPLLParam(storno_xtal_app_t *inst){
-	
-	// Read settings for PLLA first
-	cm_EEPROM_read((uint8_t*)PLLA_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->plla_param_data,sizeof(storno_pll_param_msg));
-	//_delay_ms(1);
-	cm_setInputSource(inst->si5351_dev, SI5351_CLK_SOURCE_XTAL);
-	//_delay_ms(1);
-	
-	
-	cqm_setPLLParam(inst, SI5351_PLL_A, SI5351_OUTPUT_0);
-	//_delay_ms(1);
-	
-	
-	cm_EEPROM_read((uint8_t*)PLLB_SETTINGS_EEPROM_ADDR,(uint8_t *)&inst->plla_param_data,sizeof(storno_pll_param_msg));
-	//_delay_ms(1);
-	cqm_setPLLParam(inst, SI5351_PLL_B, SI5351_OUTPUT_1);
-	
-	
-	// Set third output to crystal freq for calibration!
-	cqm_setPLLParam(inst, SI5351_PLL_B, SI5351_OUTPUT_2);
-	cm_setCLKControl(inst->si5351_dev, SI5351_OUTPUT_2,SI5351_CLK_POWER_UP);
-	//_delay_ms(1);
-	cm_setOutputEnable(inst->si5351_dev,SI5351_OUTPUT_2,SI5351_OUTPUT_ENABLE);
-
-	
-	
 }
 
 int uart_rx_event(storno_xtal_app_t *inst, void *rxData){
@@ -187,8 +197,8 @@ int uart_rx_event(storno_xtal_app_t *inst, void *rxData){
 	}
 	
 	// Add EepromWritePLLParameters to trigger to write setting to eeprom as soon as we can after ISR!
-	cm_taskManager_addTaskToList(&inst->storno_xtal_task,(void*)EepromWritePLLParameters,inst);
-	
+	//cm_taskManager_addTaskToList(&inst->storno_xtal_task,(void*)EepromWritePLLParameters,inst);
+	inst->rtx_mode = STORNO_APP_PROGRAM_EEPROM;
 	// Add write pll to list.. so the settings are updated immitialy
 	
 	return 0;
@@ -203,7 +213,7 @@ void cqm6xx_app_init(storno_xtal_app_t *inst, void *si5351_dev){
 	
 	cm_MsgCompleteEvt_Register(inst,(Get_msgComplete_Event_fpt)uart_rx_event);
 	cm_uart_init(inst,(get_UART_Event_fpt)cm_msg_DecodeMsg_Byte);
-	cm_taskManager_init(&inst->storno_xtal_task);
+	//cm_taskManager_init(&inst->storno_xtal_task);
 	
 	// Check if data is vaild (if this is a new mcu)
 	if(!isEEPROMValid(inst)){
diff --git a/storno_cqp6xx_digital_xtal/cqm6xx_app.h b/storno_cqp6xx_digital_xtal/cqm6xx_app.h
index 839fa65..7ce4698 100644
--- a/storno_cqp6xx_digital_xtal/cqm6xx_app.h
+++ b/storno_cqp6xx_digital_xtal/cqm6xx_app.h
@@ -11,6 +11,7 @@
 
 #include "stdio.h"
 #include "stdint.h"
+//#include "cm_task_manager/cm_task_manager.h"
 
 enum{
 	MSG_PLLA_PARAM = 0,
@@ -48,6 +49,7 @@ typedef struct {
 typedef enum {
 	STORNO_APP_RX_MODE = 0,
 	STORNO_APP_TX_MODE = 1,
+	STORNO_APP_PROGRAM_EEPROM = 2,
 	
 }storno_app_modes;
 
@@ -57,7 +59,7 @@ typedef struct {
 	void *si5351_dev;
 	storno_pll_param_msg plla_param_data;
 	storno_pll_param_msg pllb_param_data;
-	cm_task_manager_t storno_xtal_task;
+	//cm_task_manager_t storno_xtal_task;
 	
 	
 	
diff --git a/storno_cqp6xx_digital_xtal/storno_cqp6xx_digital_xtal.cproj b/storno_cqp6xx_digital_xtal/storno_cqp6xx_digital_xtal.cproj
index ea518f3..f1063f4 100644
--- a/storno_cqp6xx_digital_xtal/storno_cqp6xx_digital_xtal.cproj
+++ b/storno_cqp6xx_digital_xtal/storno_cqp6xx_digital_xtal.cproj
@@ -103,47 +103,47 @@
   <PropertyGroup Condition=" '$(Configuration)' == 'Debug' ">
     <ToolchainSettings>
       <AvrGcc>
-        <avrgcc.common.Device>-mmcu=attiny402 -B "%24(PackRepoDir)\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402"</avrgcc.common.Device>
-        <avrgcc.common.outputfiles.hex>True</avrgcc.common.outputfiles.hex>
-        <avrgcc.common.outputfiles.lss>True</avrgcc.common.outputfiles.lss>
-        <avrgcc.common.outputfiles.eep>True</avrgcc.common.outputfiles.eep>
-        <avrgcc.common.outputfiles.srec>True</avrgcc.common.outputfiles.srec>
-        <avrgcc.common.outputfiles.usersignatures>False</avrgcc.common.outputfiles.usersignatures>
-        <avrgcc.compiler.general.ChangeDefaultCharTypeUnsigned>True</avrgcc.compiler.general.ChangeDefaultCharTypeUnsigned>
-        <avrgcc.compiler.general.ChangeDefaultBitFieldUnsigned>True</avrgcc.compiler.general.ChangeDefaultBitFieldUnsigned>
-        <avrgcc.compiler.symbols.DefSymbols>
-          <ListValues>
-            <Value>DEBUG</Value>
-          </ListValues>
-        </avrgcc.compiler.symbols.DefSymbols>
-        <avrgcc.compiler.directories.IncludePaths>
-          <ListValues>
-            <Value>%24(PackRepoDir)\atmel\ATtiny_DFP\1.10.348\include\</Value>
-          </ListValues>
-        </avrgcc.compiler.directories.IncludePaths>
-        <avrgcc.compiler.optimization.level>Optimize (-O1)</avrgcc.compiler.optimization.level>
-        <avrgcc.compiler.optimization.PackStructureMembers>True</avrgcc.compiler.optimization.PackStructureMembers>
-        <avrgcc.compiler.optimization.AllocateBytesNeededForEnum>True</avrgcc.compiler.optimization.AllocateBytesNeededForEnum>
-        <avrgcc.compiler.optimization.DebugLevel>Default (-g2)</avrgcc.compiler.optimization.DebugLevel>
-        <avrgcc.compiler.warnings.AllWarnings>True</avrgcc.compiler.warnings.AllWarnings>
-        <avrgcc.linker.libraries.Libraries>
-          <ListValues>
-            <Value>libm</Value>
-          </ListValues>
-        </avrgcc.linker.libraries.Libraries>
-        <avrgcc.linker.libraries.LibrarySearchPaths>
-          <ListValues>
-            <Value>D:\cm_projects\microchip_studio_projects\storno_cqp6xx_digital_xtal\storno_cqp6xx_digital_xtal\si5351_driver\include</Value>
-            <Value>../avr_uart_driver</Value>
-          </ListValues>
-        </avrgcc.linker.libraries.LibrarySearchPaths>
-        <avrgcc.assembler.general.IncludePaths>
-          <ListValues>
-            <Value>%24(PackRepoDir)\atmel\ATtiny_DFP\1.10.348\include\</Value>
-          </ListValues>
-        </avrgcc.assembler.general.IncludePaths>
-        <avrgcc.assembler.debugging.DebugLevel>Default (-Wa,-g)</avrgcc.assembler.debugging.DebugLevel>
-      </AvrGcc>
+  <avrgcc.common.Device>-mmcu=attiny402 -B "%24(PackRepoDir)\atmel\ATtiny_DFP\1.10.348\gcc\dev\attiny402"</avrgcc.common.Device>
+  <avrgcc.common.outputfiles.hex>True</avrgcc.common.outputfiles.hex>
+  <avrgcc.common.outputfiles.lss>True</avrgcc.common.outputfiles.lss>
+  <avrgcc.common.outputfiles.eep>True</avrgcc.common.outputfiles.eep>
+  <avrgcc.common.outputfiles.srec>True</avrgcc.common.outputfiles.srec>
+  <avrgcc.common.outputfiles.usersignatures>False</avrgcc.common.outputfiles.usersignatures>
+  <avrgcc.compiler.general.ChangeDefaultCharTypeUnsigned>True</avrgcc.compiler.general.ChangeDefaultCharTypeUnsigned>
+  <avrgcc.compiler.general.ChangeDefaultBitFieldUnsigned>True</avrgcc.compiler.general.ChangeDefaultBitFieldUnsigned>
+  <avrgcc.compiler.symbols.DefSymbols>
+    <ListValues>
+      <Value>DEBUG</Value>
+    </ListValues>
+  </avrgcc.compiler.symbols.DefSymbols>
+  <avrgcc.compiler.directories.IncludePaths>
+    <ListValues>
+      <Value>%24(PackRepoDir)\atmel\ATtiny_DFP\1.10.348\include\</Value>
+    </ListValues>
+  </avrgcc.compiler.directories.IncludePaths>
+  <avrgcc.compiler.optimization.level>Optimize (-O1)</avrgcc.compiler.optimization.level>
+  <avrgcc.compiler.optimization.PackStructureMembers>True</avrgcc.compiler.optimization.PackStructureMembers>
+  <avrgcc.compiler.optimization.AllocateBytesNeededForEnum>True</avrgcc.compiler.optimization.AllocateBytesNeededForEnum>
+  <avrgcc.compiler.optimization.DebugLevel>Default (-g2)</avrgcc.compiler.optimization.DebugLevel>
+  <avrgcc.compiler.warnings.AllWarnings>True</avrgcc.compiler.warnings.AllWarnings>
+  <avrgcc.linker.libraries.Libraries>
+    <ListValues>
+      <Value>libm</Value>
+    </ListValues>
+  </avrgcc.linker.libraries.Libraries>
+  <avrgcc.linker.libraries.LibrarySearchPaths>
+    <ListValues>
+      <Value>D:\cm_projects\microchip_studio_projects\storno_cqp6xx_digital_xtal\storno_cqp6xx_digital_xtal\si5351_driver\include</Value>
+      <Value>../avr_uart_driver</Value>
+    </ListValues>
+  </avrgcc.linker.libraries.LibrarySearchPaths>
+  <avrgcc.assembler.general.IncludePaths>
+    <ListValues>
+      <Value>%24(PackRepoDir)\atmel\ATtiny_DFP\1.10.348\include\</Value>
+    </ListValues>
+  </avrgcc.assembler.general.IncludePaths>
+  <avrgcc.assembler.debugging.DebugLevel>Default (-Wa,-g)</avrgcc.assembler.debugging.DebugLevel>
+</AvrGcc>
     </ToolchainSettings>
   </PropertyGroup>
   <ItemGroup>