Implemented trilateration-only error calculation

Error calculation on the DisplayServer now, in addition, calculates
error only for when trilateration results are available, which fixes the
problem of the final velocity prediction affecting the error results too
heavily.

Also fixed an off-by-one error with the calculation of mean error.