Fixed LCD handling in firmware