Finish up LCD interface

Not yet tested well