Add CFast and LCD fixes

Signed-off-by: Yegor Yefremov <yegorslists@googlemail.com>