ConfigTable config;
public void robotInit(Machine machine) throws CarusoException {
this.robotPosition = new DoubleSensor(machine.getSensor(LrNames.POSITION_SENSOR));
this.robotOutput = new DoubleActuator(machine.getActuator(LrNames.OUTPUT_FORCE));
this.targetPos = new DoubleActuator(machine.getActuator(LrNames.DESIRED_POSITION));
this.targetSpeed = new DoubleActuator(machine.getActuator(LrNames.DESIRED_SPEED));
this.targetAccel = new DoubleActuator(machine.getActuator(LrNames.DESIRED_ACCEL));
this.config = machine.getConfig();
this.controller = new PredictiveLinearController(
config.getDouble(LrNames.PID_P),