Update servo.ino

function lcd but not tested