modified setpoint from vector to scalar (as it is only a distance). python gives segmentation fault.