Added lcd and drive functions