Function track_sampling

poco/utils/track.py:8–32

(track, accuracy=0.002)

def track_sampling(track, accuracy=0.002):
    # accuracy： 采样精度，都是归一化坐标系
    if len(track) <= 1:
        return track

    total_distance = 0.0
    for i in range(len(track) - 1):
        p0 = Vec2(track[i])
        p1 = Vec2(track[i + 1])
        total_distance += (p1 - p0).length

    sample_points = []
    for i in range(len(track) - 1):
        p0 = Vec2(track[i])
        p1 = Vec2(track[i + 1])
        d = p1 - p0
        seg_length = d.length
        d = (p1 - p0).unit() * accuracy
        sp = p0
        while (sp - p0).length < seg_length:
            sample_points.append(sp.to_list())
            sp = sp + d

    sample_points.append(track[-1])
    return sample_points


class MotionTrackHold(object):