fix lcd functions
remove old servo code