55 lines
1.3 KiB
C++
55 lines
1.3 KiB
C++
#ifndef LLMR_GEOMETRY_INTERPOLATE
|
|
#define LLMR_GEOMETRY_INTERPOLATE
|
|
|
|
#include <llmr/geometry/anchor.hpp>
|
|
#include <llmr/util/math.hpp>
|
|
|
|
namespace llmr {
|
|
|
|
template <typename Vertices>
|
|
Anchors interpolate(const Vertices& vertices, float spacing, float minScale = 0.0f, int start = 0) {
|
|
|
|
float distance = 0.0f;
|
|
float markedDistance = 0.0f;
|
|
int added = start;
|
|
|
|
Anchors points;
|
|
|
|
auto end = vertices.end() - 1;
|
|
int i = 0;
|
|
for (auto it = vertices.begin(); it != end; it++, i++) {
|
|
const auto& a = *(it),
|
|
b = *(it + 1);
|
|
|
|
float segmentDist = util::dist(a, b);
|
|
float angle = util::angle_to(b, a);
|
|
|
|
while (markedDistance + spacing < distance + segmentDist) {
|
|
markedDistance += spacing;
|
|
|
|
float t = (markedDistance - distance) / segmentDist,
|
|
x = util::interp(a.x, b.x, t),
|
|
y = util::interp(a.y, b.y, t),
|
|
s = added % 8 == 0 ? minScale :
|
|
added % 4 == 0 ? 2 :
|
|
added % 2 == 0 ? 4 :
|
|
8;
|
|
|
|
if (x >= 0 && x < 4096 && y >= 0 && y < 4096) {
|
|
points.emplace_back(x, y, angle, s, i);
|
|
}
|
|
|
|
added++;
|
|
}
|
|
|
|
distance += segmentDist;
|
|
}
|
|
|
|
return points;
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|