Add code for lcd (16x2)