Updated linac servo code with proportional control