16x2 LCD support and self test added