Added functions for lcd printing and US calculation