Worked on updating tele-op

Updated for the new schematic and started to implement Linear Fit