Created some macros and moved to separate file. Now address should be defined by program. Still looking for a way to get input from serial port...