Trail in Chain now updates the point instead of reseting when full

When addPoint in PointSet hits the limit it uses a circular array to
delete the first point and update it with the new one