Add lcd_fill_rect, tested in drivertest