Reduce dogm lcd code
Reduce ultralcd.cpp redundancies