sw: fix lcd initialization

Signed-off-by: Max Filippov <jcmvbkbc@gmail.com>