Add lcd_draw_rect, tested in drivertest