Relintai/pandemonium_engine
1
0
Fork 0
mirror of https://github.com/Relintai/pandemonium_engine.git synced 2024-12-25 13:17:22 +01:00
Code Issues Packages Projects Releases Wiki Activity
38a36b3c70
pandemonium_engine/modules/mesh_utils/xatlas/xatlas.cpp
Relintai 4d7df62b8e Clang format all files.
2022-03-18 19:00:13 +01:00

8381 lines
283 KiB
C++
Raw Blame History

/*
MIT License
Copyright (c) 2018-2020 Jonathan Young
Permission is hereby granted, free of charge, to any person obtaining a copy
of this software and associated documentation files (the "Software"), to deal
in the Software without restriction, including without limitation the rights
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
copies of the Software, and to permit persons to whom the Software is
furnished to do so, subject to the following conditions:
The above copyright notice and this permission notice shall be included in all
copies or substantial portions of the Software.
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
SOFTWARE.
*/
/*
thekla_atlas
https://github.com/Thekla/thekla_atlas
MIT License
Copyright (c) 2013 Thekla, Inc
Copyright NVIDIA Corporation 2006 -- Ignacio Castano <icastano@nvidia.com>
Fast-BVH
https://github.com/brandonpelfrey/Fast-BVH
MIT License
Copyright (c) 2012 Brandon Pelfrey
*/
#include "xatlas.h"
#ifndef XATLAS_C_API
#define XATLAS_C_API 0
#endif
#if XATLAS_C_API
#include "xatlas_c.h"
#endif
#include <assert.h>
#include <float.h> // FLT_MAX
#include <limits.h>
#include <math.h>
#include <atomic>
#include <condition_variable>
#include <mutex>
#include <thread>
#define __STDC_LIMIT_MACROS
#include <stdint.h>
#include <stdio.h>
#include <string.h>
#ifndef XA_DEBUG
#ifdef NDEBUG
#define XA_DEBUG 0
#else
#define XA_DEBUG 1
#endif
#endif
#ifndef XA_PROFILE
#define XA_PROFILE 0
#endif
#if XA_PROFILE
#include <chrono>
#endif
#define XA_STR(x) #x
#define XA_XSTR(x) XA_STR(x)
#ifndef XA_ASSERT
#define XA_ASSERT(exp) \
if (!(exp)) { \
XA_PRINT_WARNING("\rASSERT: %s %s %d\n", XA_XSTR(exp), __FILE__, __LINE__); \
}
#endif
#ifndef XA_DEBUG_ASSERT
#define XA_DEBUG_ASSERT(exp) assert(exp)
#endif
#ifndef XA_PRINT
#define XA_PRINT(...) \
if (xatlas_mu::internal::s_print && xatlas_mu::internal::s_printVerbose) \
xatlas_mu::internal::s_print(__VA_ARGS__);
#endif
#ifndef XA_PRINT_WARNING
#define XA_PRINT_WARNING(...) \
if (xatlas_mu::internal::s_print) \
xatlas_mu::internal::s_print(__VA_ARGS__);
#endif
#define XA_ALLOC(tag, type) (type *)internal::Realloc(nullptr, sizeof(type), tag, __FILE__, __LINE__)
#define XA_ALLOC_ARRAY(tag, type, num) (type *)internal::Realloc(nullptr, sizeof(type) * (num), tag, __FILE__, __LINE__)
#define XA_REALLOC(tag, ptr, type, num) (type *)internal::Realloc(ptr, sizeof(type) * (num), tag, __FILE__, __LINE__)
#define XA_REALLOC_SIZE(tag, ptr, size) (uint8_t *)internal::Realloc(ptr, size, tag, __FILE__, __LINE__)
#define XA_FREE(ptr) internal::Realloc(ptr, 0, internal::MemTag::Default, __FILE__, __LINE__)
#define XA_NEW(tag, type) new (XA_ALLOC(tag, type)) type()
#define XA_NEW_ARGS(tag, type, ...) new (XA_ALLOC(tag, type)) type(__VA_ARGS__)
#ifdef _MSC_VER
#define XA_INLINE __forceinline
#else
#define XA_INLINE inline
#endif
#if defined(__clang__) || defined(__GNUC__)
#define XA_NODISCARD [[nodiscard]]
#elif defined(_MSC_VER)
#define XA_NODISCARD _Check_return_
#else
#define XA_NODISCARD
#endif
#define XA_UNUSED(a) ((void)(a))
#define XA_MERGE_CHARTS 1
#define XA_MERGE_CHARTS_MIN_NORMAL_DEVIATION 0.5f
#define XA_RECOMPUTE_CHARTS 1
#define XA_CHECK_PARAM_WINDING 0
#define XA_CHECK_PIECEWISE_CHART_QUALITY 0
#define XA_CHECK_T_JUNCTIONS 0
#define XA_DEBUG_HEAP 0
#define XA_DEBUG_SINGLE_CHART 0
#define XA_DEBUG_ALL_CHARTS_INVALID 0
#define XA_DEBUG_EXPORT_ATLAS_IMAGES 0
#define XA_DEBUG_EXPORT_ATLAS_IMAGES_PER_CHART 0 // Export an atlas image after each chart is added.
#define XA_DEBUG_EXPORT_BOUNDARY_GRID 0
#define XA_DEBUG_EXPORT_OBJ_FACE_GROUPS 0
#define XA_DEBUG_EXPORT_OBJ_CHART_GROUPS 0
#define XA_DEBUG_EXPORT_OBJ_PLANAR_REGIONS 0
#define XA_DEBUG_EXPORT_OBJ_CHARTS 0
#define XA_DEBUG_EXPORT_OBJ_TJUNCTION 0 // XA_CHECK_T_JUNCTIONS must also be set
#define XA_DEBUG_EXPORT_OBJ_CHARTS_AFTER_PARAMETERIZATION 0
#define XA_DEBUG_EXPORT_OBJ_INVALID_PARAMETERIZATION 0
#define XA_DEBUG_EXPORT_OBJ_RECOMPUTED_CHARTS 0
#define XA_DEBUG_EXPORT_OBJ (0 || XA_DEBUG_EXPORT_OBJ_FACE_GROUPS || XA_DEBUG_EXPORT_OBJ_CHART_GROUPS || XA_DEBUG_EXPORT_OBJ_PLANAR_REGIONS || XA_DEBUG_EXPORT_OBJ_CHARTS || XA_DEBUG_EXPORT_OBJ_TJUNCTION || XA_DEBUG_EXPORT_OBJ_CHARTS_AFTER_PARAMETERIZATION || XA_DEBUG_EXPORT_OBJ_INVALID_PARAMETERIZATION || XA_DEBUG_EXPORT_OBJ_RECOMPUTED_CHARTS)
#ifdef _MSC_VER
#define XA_FOPEN(_file, _filename, _mode) \
{ \
if (fopen_s(&_file, _filename, _mode) != 0) \
_file = NULL; \
}
#define XA_SPRINTF(_buffer, _size, _format, ...) sprintf_s(_buffer, _size, _format, __VA_ARGS__)
#else
#define XA_FOPEN(_file, _filename, _mode) _file = fopen(_filename, _mode)
#define XA_SPRINTF(_buffer, _size, _format, ...) sprintf(_buffer, _format, __VA_ARGS__)
#endif
namespace xatlas_mu {
namespace internal {
static ReallocFunc s_realloc = realloc;
static FreeFunc s_free = free;
static PrintFunc s_print = printf;
static bool s_printVerbose = false;
#if XA_PROFILE
typedef uint64_t Duration;
#define XA_PROFILE_START(var) const std::chrono::time_point<std::chrono::high_resolution_clock> var##Start = std::chrono::high_resolution_clock::now();
#define XA_PROFILE_END(var) internal::s_profile.var += uint64_t(std::chrono::duration_cast<std::chrono::microseconds>(std::chrono::high_resolution_clock::now() - var##Start).count());
#define XA_PROFILE_PRINT_AND_RESET(label, var) \
XA_PRINT("%s%.2f seconds (%g ms)\n", label, internal::durationToSeconds(internal::s_profile.var), internal::durationToMs(internal::s_profile.var)); \
internal::s_profile.var = 0u;
#define XA_PROFILE_ALLOC 0
struct ProfileData {
#if XA_PROFILE_ALLOC
std::atomic<Duration> alloc;
#endif
std::chrono::time_point<std::chrono::high_resolution_clock> addMeshRealStart;
Duration addMeshReal;
Duration addMeshCopyData;
std::atomic<Duration> addMeshThread;
std::atomic<Duration> addMeshCreateColocals;
Duration computeChartsReal;
std::atomic<Duration> computeChartsThread;
std::atomic<Duration> createFaceGroups;
std::atomic<Duration> extractInvalidMeshGeometry;
std::atomic<Duration> chartGroupComputeChartsReal;
std::atomic<Duration> chartGroupComputeChartsThread;
std::atomic<Duration> createChartGroupMesh;
std::atomic<Duration> createChartGroupMeshColocals;
std::atomic<Duration> createChartGroupMeshBoundaries;
std::atomic<Duration> buildAtlas;
std::atomic<Duration> buildAtlasInit;
std::atomic<Duration> planarCharts;
std::atomic<Duration> originalUvCharts;
std::atomic<Duration> clusteredCharts;
std::atomic<Duration> clusteredChartsPlaceSeeds;
std::atomic<Duration> clusteredChartsPlaceSeedsBoundaryIntersection;
std::atomic<Duration> clusteredChartsRelocateSeeds;
std::atomic<Duration> clusteredChartsReset;
std::atomic<Duration> clusteredChartsGrow;
std::atomic<Duration> clusteredChartsGrowBoundaryIntersection;
std::atomic<Duration> clusteredChartsMerge;
std::atomic<Duration> clusteredChartsFillHoles;
std::atomic<Duration> copyChartFaces;
std::atomic<Duration> createChartMeshAndParameterizeReal;
std::atomic<Duration> createChartMeshAndParameterizeThread;
std::atomic<Duration> createChartMesh;
std::atomic<Duration> parameterizeCharts;
std::atomic<Duration> parameterizeChartsOrthogonal;
std::atomic<Duration> parameterizeChartsLSCM;
std::atomic<Duration> parameterizeChartsRecompute;
std::atomic<Duration> parameterizeChartsPiecewise;
std::atomic<Duration> parameterizeChartsPiecewiseBoundaryIntersection;
std::atomic<Duration> parameterizeChartsEvaluateQuality;
Duration packCharts;
Duration packChartsAddCharts;
std::atomic<Duration> packChartsAddChartsThread;
std::atomic<Duration> packChartsAddChartsRestoreTexcoords;
Duration packChartsRasterize;
Duration packChartsDilate;
Duration packChartsFindLocation;
Duration packChartsBlit;
Duration buildOutputMeshes;
};
static ProfileData s_profile;
static double durationToMs(Duration c) {
return (double)c * 0.001;
}
static double durationToSeconds(Duration c) {
return (double)c * 0.000001;
}
#else
#define XA_PROFILE_START(var)
#define XA_PROFILE_END(var)
#define XA_PROFILE_PRINT_AND_RESET(label, var)
#define XA_PROFILE_ALLOC 0
#endif
struct MemTag {
enum {
Default,
BitImage,
BVH,
Matrix,
Mesh,
MeshBoundaries,
MeshColocals,
MeshEdgeMap,
MeshIndices,
MeshNormals,
MeshPositions,
MeshTexcoords,
OpenNL,
SegmentAtlasChartCandidates,
SegmentAtlasChartFaces,
SegmentAtlasMeshData,
SegmentAtlasPlanarRegions,
Count
};
};
#if XA_DEBUG_HEAP
struct AllocHeader {
size_t size;
const char *file;
int line;
int tag;
uint32_t id;
AllocHeader *prev, *next;
bool free;
};
static std::mutex s_allocMutex;
static AllocHeader *s_allocRoot = nullptr;
static size_t s_allocTotalCount = 0, s_allocTotalSize = 0, s_allocPeakSize = 0, s_allocCount[MemTag::Count] = { 0 }, s_allocTotalTagSize[MemTag::Count] = { 0 }, s_allocPeakTagSize[MemTag::Count] = { 0 };
static uint32_t s_allocId = 0;
static constexpr uint32_t kAllocRedzone = 0x12345678;
static void *Realloc(void *ptr, size_t size, int tag, const char *file, int line) {
std::unique_lock<std::mutex> lock(s_allocMutex);
if (!size && !ptr)
return nullptr;
uint8_t *realPtr = nullptr;
AllocHeader *header = nullptr;
if (ptr) {
realPtr = ((uint8_t *)ptr) - sizeof(AllocHeader);
header = (AllocHeader *)realPtr;
}
if (realPtr && size) {
s_allocTotalSize -= header->size;
s_allocTotalTagSize[header->tag] -= header->size;
// realloc, remove.
if (header->prev)
header->prev->next = header->next;
else
s_allocRoot = header->next;
if (header->next)
header->next->prev = header->prev;
}
if (!size) {
s_allocTotalSize -= header->size;
s_allocTotalTagSize[header->tag] -= header->size;
XA_ASSERT(!header->free); // double free
header->free = true;
return nullptr;
}
size += sizeof(AllocHeader) + sizeof(kAllocRedzone);
uint8_t *newPtr = (uint8_t *)s_realloc(realPtr, size);
if (!newPtr)
return nullptr;
header = (AllocHeader *)newPtr;
header->size = size;
header->file = file;
header->line = line;
header->tag = tag;
header->id = s_allocId++;
header->free = false;
if (!s_allocRoot) {
s_allocRoot = header;
header->prev = header->next = 0;
} else {
header->prev = nullptr;
header->next = s_allocRoot;
s_allocRoot = header;
header->next->prev = header;
}
s_allocTotalCount++;
s_allocTotalSize += size;
if (s_allocTotalSize > s_allocPeakSize)
s_allocPeakSize = s_allocTotalSize;
s_allocCount[tag]++;
s_allocTotalTagSize[tag] += size;
if (s_allocTotalTagSize[tag] > s_allocPeakTagSize[tag])
s_allocPeakTagSize[tag] = s_allocTotalTagSize[tag];
auto redzone = (uint32_t *)(newPtr + size - sizeof(kAllocRedzone));
*redzone = kAllocRedzone;
return newPtr + sizeof(AllocHeader);
}
static void ReportLeaks() {
printf("Checking for memory leaks...\n");
bool anyLeaks = false;
AllocHeader *header = s_allocRoot;
while (header) {
if (!header->free) {
printf(" Leak: ID %u, %zu bytes, %s %d\n", header->id, header->size, header->file, header->line);
anyLeaks = true;
}
auto redzone = (const uint32_t *)((const uint8_t *)header + header->size - sizeof(kAllocRedzone));
if (*redzone != kAllocRedzone)
printf(" Redzone corrupted: %zu bytes %s %d\n", header->size, header->file, header->line);
header = header->next;
}
if (!anyLeaks)
printf(" No memory leaks\n");
header = s_allocRoot;
while (header) {
AllocHeader *destroy = header;
header = header->next;
s_realloc(destroy, 0);
}
s_allocRoot = nullptr;
s_allocTotalSize = s_allocPeakSize = 0;
for (int i = 0; i < MemTag::Count; i++)
s_allocTotalTagSize[i] = s_allocPeakTagSize[i] = 0;
}
static void PrintMemoryUsage() {
XA_PRINT("Total allocations: %zu\n", s_allocTotalCount);
XA_PRINT("Memory usage: %0.2fMB current, %0.2fMB peak\n", internal::s_allocTotalSize / 1024.0f / 1024.0f, internal::s_allocPeakSize / 1024.0f / 1024.0f);
static const char *labels[] = { // Sync with MemTag
"Default",
"BitImage",
"BVH",
"Matrix",
"Mesh",
"MeshBoundaries",
"MeshColocals",
"MeshEdgeMap",
"MeshIndices",
"MeshNormals",
"MeshPositions",
"MeshTexcoords",
"OpenNL",
"SegmentAtlasChartCandidates",
"SegmentAtlasChartFaces",
"SegmentAtlasMeshData",
"SegmentAtlasPlanarRegions"
};
for (int i = 0; i < MemTag::Count; i++) {
XA_PRINT(" %s: %zu allocations, %0.2fMB current, %0.2fMB peak\n", labels[i], internal::s_allocCount[i], internal::s_allocTotalTagSize[i] / 1024.0f / 1024.0f, internal::s_allocPeakTagSize[i] / 1024.0f / 1024.0f);
}
}
#define XA_PRINT_MEM_USAGE internal::PrintMemoryUsage();
#else
static void *Realloc(void *ptr, size_t size, int /*tag*/, const char * /*file*/, int /*line*/) {
if (size == 0 && !ptr)
return nullptr;
if (size == 0 && s_free) {
s_free(ptr);
return nullptr;
}
#if XA_PROFILE_ALLOC
XA_PROFILE_START(alloc)
#endif
void *mem = s_realloc(ptr, size);
#if XA_PROFILE_ALLOC
XA_PROFILE_END(alloc)
#endif
XA_DEBUG_ASSERT(size <= 0 || (size > 0 && mem));
return mem;
}
#define XA_PRINT_MEM_USAGE
#endif
static constexpr float kPi = 3.14159265358979323846f;
static constexpr float kPi2 = 6.28318530717958647692f;
static constexpr float kEpsilon = 0.0001f;
static constexpr float kAreaEpsilon = FLT_EPSILON;
static constexpr float kNormalEpsilon = 0.001f;
static int align(int x, int a) {
return (x + a - 1) & ~(a - 1);
}
template <typename T>
static T max(const T &a, const T &b) {
return a > b ? a : b;
}
template <typename T>
static T min(const T &a, const T &b) {
return a < b ? a : b;
}
template <typename T>
static T max3(const T &a, const T &b, const T &c) {
return max(a, max(b, c));
}
/// Return the maximum of the three arguments.
template <typename T>
static T min3(const T &a, const T &b, const T &c) {
return min(a, min(b, c));
}
/// Clamp between two values.
template <typename T>
static T clamp(const T &x, const T &a, const T &b) {
return min(max(x, a), b);
}
template <typename T>
static void swap(T &a, T &b) {
T temp = a;
a = b;
b = temp;
}
union FloatUint32 {
float f;
uint32_t u;
};
static bool isFinite(float f) {
FloatUint32 fu;
fu.f = f;
return fu.u != 0x7F800000u && fu.u != 0x7F800001u;
}
static bool isNan(float f) {
return f != f;
}
// Robust floating point comparisons:
// http://realtimecollisiondetection.net/blog/?p=89
static bool equal(const float f0, const float f1, const float epsilon) {
//return fabs(f0-f1) <= epsilon;
return fabs(f0 - f1) <= epsilon * max3(1.0f, fabsf(f0), fabsf(f1));
}
static int ftoi_ceil(float val) {
return (int)ceilf(val);
}
static bool isZero(const float f, const float epsilon) {
return fabs(f) <= epsilon;
}
static float square(float f) {
return f * f;
}
/** Return the next power of two.
* @see http://graphics.stanford.edu/~seander/bithacks.html
* @warning Behaviour for 0 is undefined.
* @note isPowerOfTwo(x) -> nextPowerOfTwo(x) == x
* @note nextPowerOfTwo(x) = 2 << log2(x-1)
*/
static uint32_t nextPowerOfTwo(uint32_t x) {
XA_DEBUG_ASSERT(x != 0);
// On modern CPUs this is supposed to be as fast as using the bsr instruction.
x--;
x |= x >> 1;
x |= x >> 2;
x |= x >> 4;
x |= x >> 8;
x |= x >> 16;
return x + 1;
}
class Vector2 {
public:
Vector2() {}
explicit Vector2(float f) :
x(f), y(f) {}
Vector2(float _x, float _y) :
x(_x), y(_y) {}
Vector2 operator-() const {
return Vector2(-x, -y);
}
void operator+=(const Vector2 &v) {
x += v.x;
y += v.y;
}
void operator-=(const Vector2 &v) {
x -= v.x;
y -= v.y;
}
void operator*=(float s) {
x *= s;
y *= s;
}
void operator*=(const Vector2 &v) {
x *= v.x;
y *= v.y;
}
float x, y;
};
static bool operator==(const Vector2 &a, const Vector2 &b) {
return a.x == b.x && a.y == b.y;
}
static bool operator!=(const Vector2 &a, const Vector2 &b) {
return a.x != b.x || a.y != b.y;
}
/*static Vector2 operator+(const Vector2 &a, const Vector2 &b)
{
return Vector2(a.x + b.x, a.y + b.y);
}*/
static Vector2 operator-(const Vector2 &a, const Vector2 &b) {
return Vector2(a.x - b.x, a.y - b.y);
}
static Vector2 operator*(const Vector2 &v, float s) {
return Vector2(v.x * s, v.y * s);
}
static float dot(const Vector2 &a, const Vector2 &b) {
return a.x * b.x + a.y * b.y;
}
static float lengthSquared(const Vector2 &v) {
return v.x * v.x + v.y * v.y;
}
static float length(const Vector2 &v) {
return sqrtf(lengthSquared(v));
}
#if XA_DEBUG
static bool isNormalized(const Vector2 &v, float epsilon = kNormalEpsilon) {
return equal(length(v), 1, epsilon);
}
#endif
static Vector2 normalize(const Vector2 &v) {
const float l = length(v);
XA_DEBUG_ASSERT(l > 0.0f); // Never negative.
const Vector2 n = v * (1.0f / l);
XA_DEBUG_ASSERT(isNormalized(n));
return n;
}
static Vector2 normalizeSafe(const Vector2 &v, const Vector2 &fallback) {
const float l = length(v);
if (l > 0.0f) // Never negative.
return v * (1.0f / l);
return fallback;
}
static bool equal(const Vector2 &v1, const Vector2 &v2, float epsilon) {
return equal(v1.x, v2.x, epsilon) && equal(v1.y, v2.y, epsilon);
}
static Vector2 min(const Vector2 &a, const Vector2 &b) {
return Vector2(min(a.x, b.x), min(a.y, b.y));
}
static Vector2 max(const Vector2 &a, const Vector2 &b) {
return Vector2(max(a.x, b.x), max(a.y, b.y));
}
static bool isFinite(const Vector2 &v) {
return isFinite(v.x) && isFinite(v.y);
}
static float triangleArea(const Vector2 &a, const Vector2 &b, const Vector2 &c) {
// IC: While it may be appealing to use the following expression:
//return (c.x * a.y + a.x * b.y + b.x * c.y - b.x * a.y - c.x * b.y - a.x * c.y) * 0.5f;
// That's actually a terrible idea. Small triangles far from the origin can end up producing fairly large floating point
// numbers and the results becomes very unstable and dependent on the order of the factors.
// Instead, it's preferable to subtract the vertices first, and multiply the resulting small values together. The result
// in this case is always much more accurate (as long as the triangle is small) and less dependent of the location of
// the triangle.
//return ((a.x - c.x) * (b.y - c.y) - (a.y - c.y) * (b.x - c.x)) * 0.5f;
const Vector2 v0 = a - c;
const Vector2 v1 = b - c;
return (v0.x * v1.y - v0.y * v1.x) * 0.5f;
}
static bool linesIntersect(const Vector2 &a1, const Vector2 &a2, const Vector2 &b1, const Vector2 &b2, float epsilon) {
const Vector2 v0 = a2 - a1;
const Vector2 v1 = b2 - b1;
const float denom = -v1.x * v0.y + v0.x * v1.y;
if (equal(denom, 0.0f, epsilon))
return false;
const float s = (-v0.y * (a1.x - b1.x) + v0.x * (a1.y - b1.y)) / denom;
if (s > epsilon && s < 1.0f - epsilon) {
const float t = (v1.x * (a1.y - b1.y) - v1.y * (a1.x - b1.x)) / denom;
return t > epsilon && t < 1.0f - epsilon;
}
return false;
}
struct Vector2i {
Vector2i() {}
Vector2i(int32_t _x, int32_t _y) :
x(_x), y(_y) {}
int32_t x, y;
};
class Vector3 {
public:
Vector3() {}
explicit Vector3(float f) :
x(f), y(f), z(f) {}
Vector3(float _x, float _y, float _z) :
x(_x), y(_y), z(_z) {}
Vector3(const Vector2 &v, float _z) :
x(v.x), y(v.y), z(_z) {}
Vector2 xy() const {
return Vector2(x, y);
}
Vector3 operator-() const {
return Vector3(-x, -y, -z);
}
void operator+=(const Vector3 &v) {
x += v.x;
y += v.y;
z += v.z;
}
void operator-=(const Vector3 &v) {
x -= v.x;
y -= v.y;
z -= v.z;
}
void operator*=(float s) {
x *= s;
y *= s;
z *= s;
}
void operator/=(float s) {
float is = 1.0f / s;
x *= is;
y *= is;
z *= is;
}
void operator*=(const Vector3 &v) {
x *= v.x;
y *= v.y;
z *= v.z;
}
void operator/=(const Vector3 &v) {
x /= v.x;
y /= v.y;
z /= v.z;
}
float x, y, z;
};
static Vector3 operator+(const Vector3 &a, const Vector3 &b) {
return Vector3(a.x + b.x, a.y + b.y, a.z + b.z);
}
static Vector3 operator-(const Vector3 &a, const Vector3 &b) {
return Vector3(a.x - b.x, a.y - b.y, a.z - b.z);
}
/*
static bool operator==(const Vector3 &a, const Vector3 &b) {
return a.x == b.x && a.y == b.y && a.z == b.z;
}*/
static Vector3 cross(const Vector3 &a, const Vector3 &b) {
return Vector3(a.y * b.z - a.z * b.y, a.z * b.x - a.x * b.z, a.x * b.y - a.y * b.x);
}
static Vector3 operator*(const Vector3 &v, float s) {
return Vector3(v.x * s, v.y * s, v.z * s);
}
static Vector3 operator/(const Vector3 &v, float s) {
return v * (1.0f / s);
}
static float dot(const Vector3 &a, const Vector3 &b) {
return a.x * b.x + a.y * b.y + a.z * b.z;
}
static float lengthSquared(const Vector3 &v) {
return v.x * v.x + v.y * v.y + v.z * v.z;
}
static float length(const Vector3 &v) {
return sqrtf(lengthSquared(v));
}
static bool isNormalized(const Vector3 &v, float epsilon = kNormalEpsilon) {
return equal(length(v), 1.0f, epsilon);
}
static Vector3 normalize(const Vector3 &v) {
const float l = length(v);
XA_DEBUG_ASSERT(l > 0.0f); // Never negative.
const Vector3 n = v * (1.0f / l);
XA_DEBUG_ASSERT(isNormalized(n));
return n;
}
static Vector3 normalizeSafe(const Vector3 &v, const Vector3 &fallback) {
const float l = length(v);
if (l > 0.0f) // Never negative.
return v * (1.0f / l);
return fallback;
}
/*
static bool equal(const Vector3 &v0, const Vector3 &v1, float epsilon) {
return fabs(v0.x - v1.x) <= epsilon && fabs(v0.y - v1.y) <= epsilon && fabs(v0.z - v1.z) <= epsilon;
}*/
static Vector3 min(const Vector3 &a, const Vector3 &b) {
return Vector3(min(a.x, b.x), min(a.y, b.y), min(a.z, b.z));
}
static Vector3 max(const Vector3 &a, const Vector3 &b) {
return Vector3(max(a.x, b.x), max(a.y, b.y), max(a.z, b.z));
}
#if XA_DEBUG
bool isFinite(const Vector3 &v) {
return isFinite(v.x) && isFinite(v.y) && isFinite(v.z);
}
#endif
struct Extents2 {
Vector2 min, max;
Extents2() {}
Extents2(Vector2 p1, Vector2 p2) {
min = xatlas_mu::internal::min(p1, p2);
max = xatlas_mu::internal::max(p1, p2);
}
void reset() {
min.x = min.y = FLT_MAX;
max.x = max.y = -FLT_MAX;
}
void add(Vector2 p) {
min = xatlas_mu::internal::min(min, p);
max = xatlas_mu::internal::max(max, p);
}
Vector2 midpoint() const {
return Vector2(min.x + (max.x - min.x) * 0.5f, min.y + (max.y - min.y) * 0.5f);
}
static bool intersect(const Extents2 &e1, const Extents2 &e2) {
return e1.min.x <= e2.max.x && e1.max.x >= e2.min.x && e1.min.y <= e2.max.y && e1.max.y >= e2.min.y;
}
};
// From Fast-BVH
struct AABB {
AABB() :
min(FLT_MAX, FLT_MAX, FLT_MAX), max(-FLT_MAX, -FLT_MAX, -FLT_MAX) {}
AABB(const Vector3 &_min, const Vector3 &_max) :
min(_min), max(_max) {}
AABB(const Vector3 &p, float radius = 0.0f) :
min(p), max(p) {
if (radius > 0.0f)
expand(radius);
}
bool intersect(const AABB &other) const {
return min.x <= other.max.x && max.x >= other.min.x && min.y <= other.max.y && max.y >= other.min.y && min.z <= other.max.z && max.z >= other.min.z;
}
void expandToInclude(const Vector3 &p) {
min = internal::min(min, p);
max = internal::max(max, p);
}
void expandToInclude(const AABB &aabb) {
min = internal::min(min, aabb.min);
max = internal::max(max, aabb.max);
}
void expand(float amount) {
min -= Vector3(amount);
max += Vector3(amount);
}
Vector3 centroid() const {
return min + (max - min) * 0.5f;
}
uint32_t maxDimension() const {
const Vector3 extent = max - min;
uint32_t result = 0;
if (extent.y > extent.x) {
result = 1;
if (extent.z > extent.y)
result = 2;
} else if (extent.z > extent.x)
result = 2;
return result;
}
Vector3 min, max;
};
struct ArrayBase {
ArrayBase(uint32_t _elementSize, int memTag = MemTag::Default) :
buffer(nullptr), elementSize(_elementSize), size(0), capacity(0) {
#if XA_DEBUG_HEAP
this->memTag = memTag;
#else
XA_UNUSED(memTag);
#endif
}
~ArrayBase() {
XA_FREE(buffer);
}
XA_INLINE void clear() {
size = 0;
}
void copyFrom(const uint8_t *data, uint32_t length) {
XA_DEBUG_ASSERT(data);
XA_DEBUG_ASSERT(length > 0);
resize(length, true);
if (buffer && data && length > 0)
memcpy(buffer, data, length * elementSize);
}
void copyTo(ArrayBase &other) const {
XA_DEBUG_ASSERT(elementSize == other.elementSize);
XA_DEBUG_ASSERT(size > 0);
other.resize(size, true);
if (other.buffer && buffer && size > 0)
memcpy(other.buffer, buffer, size * elementSize);
}
void destroy() {
size = 0;
XA_FREE(buffer);
buffer = nullptr;
capacity = 0;
size = 0;
}
// Insert the given element at the given index shifting all the elements up.
void insertAt(uint32_t index, const uint8_t *value) {
XA_DEBUG_ASSERT(index >= 0 && index <= size);
XA_DEBUG_ASSERT(value);
resize(size + 1, false);
XA_DEBUG_ASSERT(buffer);
if (buffer && index < size - 1)
memmove(buffer + elementSize * (index + 1), buffer + elementSize * index, elementSize * (size - 1 - index));
if (buffer && value)
memcpy(&buffer[index * elementSize], value, elementSize);
}
void moveTo(ArrayBase &other) {
XA_DEBUG_ASSERT(elementSize == other.elementSize);
other.destroy();
other.buffer = buffer;
other.elementSize = elementSize;
other.size = size;
other.capacity = capacity;
#if XA_DEBUG_HEAP
other.memTag = memTag;
#endif
buffer = nullptr;
elementSize = size = capacity = 0;
}
void pop_back() {
XA_DEBUG_ASSERT(size > 0);
resize(size - 1, false);
}
void push_back(const uint8_t *value) {
XA_DEBUG_ASSERT(value < buffer || value >= buffer + size);
XA_DEBUG_ASSERT(value);
resize(size + 1, false);
XA_DEBUG_ASSERT(buffer);
if (buffer && value)
memcpy(&buffer[(size - 1) * elementSize], value, elementSize);
}
void push_back(const ArrayBase &other) {
XA_DEBUG_ASSERT(elementSize == other.elementSize);
if (other.size > 0) {
const uint32_t oldSize = size;
resize(size + other.size, false);
XA_DEBUG_ASSERT(buffer);
if (buffer)
memcpy(buffer + oldSize * elementSize, other.buffer, other.size * other.elementSize);
}
}
// Remove the element at the given index. This is an expensive operation!
void removeAt(uint32_t index) {
XA_DEBUG_ASSERT(index >= 0 && index < size);
XA_DEBUG_ASSERT(buffer);
if (buffer) {
if (size > 1)
memmove(buffer + elementSize * index, buffer + elementSize * (index + 1), elementSize * (size - 1 - index));
if (size > 0)
size--;
}
}
// Element at index is swapped with the last element, then the array length is decremented.
void removeAtFast(uint32_t index) {
XA_DEBUG_ASSERT(index >= 0 && index < size);
XA_DEBUG_ASSERT(buffer);
if (buffer) {
if (size > 1 && index != size - 1)
memcpy(buffer + elementSize * index, buffer + elementSize * (size - 1), elementSize);
if (size > 0)
size--;
}
}
void reserve(uint32_t desiredSize) {
if (desiredSize > capacity)
setArrayCapacity(desiredSize);
}
void resize(uint32_t newSize, bool exact) {
size = newSize;
if (size > capacity) {
// First allocation is always exact. Otherwise, following allocations grow array to 150% of desired size.
uint32_t newBufferSize;
if (capacity == 0 || exact)
newBufferSize = size;
else
newBufferSize = size + (size >> 2);
setArrayCapacity(newBufferSize);
}
}
void setArrayCapacity(uint32_t newCapacity) {
XA_DEBUG_ASSERT(newCapacity >= size);
if (newCapacity == 0) {
// free the buffer.
if (buffer != nullptr) {
XA_FREE(buffer);
buffer = nullptr;
}
} else {
// realloc the buffer
#if XA_DEBUG_HEAP
buffer = XA_REALLOC_SIZE(memTag, buffer, newCapacity * elementSize);
#else
buffer = XA_REALLOC_SIZE(MemTag::Default, buffer, newCapacity * elementSize);
#endif
}
capacity = newCapacity;
}
#if XA_DEBUG_HEAP
void setMemTag(int _memTag) {
this->memTag = _memTag;
}
#endif
uint8_t *buffer;
uint32_t elementSize;
uint32_t size;
uint32_t capacity;
#if XA_DEBUG_HEAP
int memTag;
#endif
};
template <typename T>
class Array {
public:
Array(int memTag = MemTag::Default) :
m_base(sizeof(T), memTag) {}
Array(const Array &) = delete;
Array &operator=(const Array &) = delete;
XA_INLINE const T &operator[](uint32_t index) const {
XA_DEBUG_ASSERT(index < m_base.size);
XA_DEBUG_ASSERT(m_base.buffer);
return ((const T *)m_base.buffer)[index];
}
XA_INLINE T &operator[](uint32_t index) {
XA_DEBUG_ASSERT(index < m_base.size);
XA_DEBUG_ASSERT(m_base.buffer);
return ((T *)m_base.buffer)[index];
}
XA_INLINE const T &back() const {
XA_DEBUG_ASSERT(!isEmpty());
return ((const T *)m_base.buffer)[m_base.size - 1];
}
XA_INLINE T *begin() { return (T *)m_base.buffer; }
XA_INLINE void clear() { m_base.clear(); }
bool contains(const T &value) const {
for (uint32_t i = 0; i < m_base.size; i++) {
if (((const T *)m_base.buffer)[i] == value)
return true;
}
return false;
}
void copyFrom(const T *data, uint32_t length) { m_base.copyFrom((const uint8_t *)data, length); }
void copyTo(Array &other) const { m_base.copyTo(other.m_base); }
XA_INLINE const T *data() const { return (const T *)m_base.buffer; }
XA_INLINE T *data() { return (T *)m_base.buffer; }
void destroy() { m_base.destroy(); }
XA_INLINE T *end() { return (T *)m_base.buffer + m_base.size; }
XA_INLINE bool isEmpty() const { return m_base.size == 0; }
void insertAt(uint32_t index, const T &value) { m_base.insertAt(index, (const uint8_t *)&value); }
void moveTo(Array &other) { m_base.moveTo(other.m_base); }
void push_back(const T &value) { m_base.push_back((const uint8_t *)&value); }
void push_back(const Array &other) { m_base.push_back(other.m_base); }
void pop_back() { m_base.pop_back(); }
void removeAt(uint32_t index) { m_base.removeAt(index); }
void removeAtFast(uint32_t index) { m_base.removeAtFast(index); }
void reserve(uint32_t desiredSize) { m_base.reserve(desiredSize); }
void resize(uint32_t newSize) { m_base.resize(newSize, true); }
void runCtors() {
for (uint32_t i = 0; i < m_base.size; i++)
new (&((T *)m_base.buffer)[i]) T;
}
void runDtors() {
for (uint32_t i = 0; i < m_base.size; i++)
((T *)m_base.buffer)[i].~T();
}
void fill(const T &value) {
auto buffer = (T *)m_base.buffer;
for (uint32_t i = 0; i < m_base.size; i++)
buffer[i] = value;
}
void fillBytes(uint8_t value) {
if (m_base.buffer && m_base.size > 0)
memset(m_base.buffer, (int)value, m_base.size * m_base.elementSize);
}
#if XA_DEBUG_HEAP
void setMemTag(int memTag) { m_base.setMemTag(memTag); }
#endif
XA_INLINE uint32_t size() const { return m_base.size; }
XA_INLINE void zeroOutMemory() {
if (m_base.buffer && m_base.size > 0)
memset(m_base.buffer, 0, m_base.elementSize * m_base.size);
}
private:
ArrayBase m_base;
};
template <typename T>
struct ArrayView {
ArrayView() :
data(nullptr), length(0) {}
ArrayView(Array<T> &a) :
data(a.data()), length(a.size()) {}
ArrayView(T *_data, uint32_t _length) :
data(_data), length(_length) {}
ArrayView &operator=(Array<T> &a) {
data = a.data();
length = a.size();
return *this;
}
XA_INLINE const T &operator[](uint32_t index) const {
XA_DEBUG_ASSERT(index < length);
return data[index];
}
XA_INLINE T &operator[](uint32_t index) {
XA_DEBUG_ASSERT(index < length);
return data[index];
}
T *data;
uint32_t length;
};
template <typename T>
struct ConstArrayView {
ConstArrayView() :
data(nullptr), length(0) {}
ConstArrayView(const Array<T> &a) :
data(a.data()), length(a.size()) {}
ConstArrayView(ArrayView<T> av) :
data(av.data), length(av.length) {}
ConstArrayView(const T *_data, uint32_t _length) :
data(_data), length(_length) {}
ConstArrayView &operator=(const Array<T> &a) {
data = a.data();
length = a.size();
return *this;
}
XA_INLINE const T &operator[](uint32_t index) const {
XA_DEBUG_ASSERT(index < length);
return data[index];
}
const T *data;
uint32_t length;
};
/// Basis class to compute tangent space basis, ortogonalizations and to transform vectors from one space to another.
struct Basis {
XA_NODISCARD static Vector3 computeTangent(const Vector3 &normal) {
XA_ASSERT(isNormalized(normal));
// Choose minimum axis.
Vector3 tangent;
if (fabsf(normal.x) < fabsf(normal.y) && fabsf(normal.x) < fabsf(normal.z))
tangent = Vector3(1, 0, 0);
else if (fabsf(normal.y) < fabsf(normal.z))
tangent = Vector3(0, 1, 0);
else
tangent = Vector3(0, 0, 1);
// Ortogonalize
tangent -= normal * dot(normal, tangent);
tangent = normalize(tangent);
return tangent;
}
XA_NODISCARD static Vector3 computeBitangent(const Vector3 &normal, const Vector3 &tangent) {
return cross(normal, tangent);
}
Vector3 tangent = Vector3(0.0f);
Vector3 bitangent = Vector3(0.0f);
Vector3 normal = Vector3(0.0f);
};
// Simple bit array.
class BitArray {
public:
BitArray() :
m_size(0) {}
BitArray(uint32_t sz) {
resize(sz);
}
void resize(uint32_t new_size) {
m_size = new_size;
m_wordArray.resize((m_size + 31) >> 5);
}
bool get(uint32_t index) const {
XA_DEBUG_ASSERT(index < m_size);
return (m_wordArray[index >> 5] & (1 << (index & 31))) != 0;
}
void set(uint32_t index) {
XA_DEBUG_ASSERT(index < m_size);
m_wordArray[index >> 5] |= (1 << (index & 31));
}
void unset(uint32_t index) {
XA_DEBUG_ASSERT(index < m_size);
m_wordArray[index >> 5] &= ~(1 << (index & 31));
}
void zeroOutMemory() {
m_wordArray.zeroOutMemory();
}
private:
uint32_t m_size; // Number of bits stored.
Array<uint32_t> m_wordArray;
};
class BitImage {
public:
BitImage() :
m_width(0), m_height(0), m_rowStride(0), m_data(MemTag::BitImage) {}
BitImage(uint32_t w, uint32_t h) :
m_width(w), m_height(h), m_data(MemTag::BitImage) {
m_rowStride = (m_width + 63) >> 6;
m_data.resize(m_rowStride * m_height);
m_data.zeroOutMemory();
}
BitImage(const BitImage &other) = delete;
BitImage &operator=(const BitImage &other) = delete;
uint32_t width() const { return m_width; }
uint32_t height() const { return m_height; }
void copyTo(BitImage &other) {
other.m_width = m_width;
other.m_height = m_height;
other.m_rowStride = m_rowStride;
m_data.copyTo(other.m_data);
}
void resize(uint32_t w, uint32_t h, bool discard) {
const uint32_t rowStride = (w + 63) >> 6;
if (discard) {
m_data.resize(rowStride * h);
m_data.zeroOutMemory();
} else {
Array<uint64_t> tmp;
tmp.resize(rowStride * h);
memset(tmp.data(), 0, tmp.size() * sizeof(uint64_t));
// If only height has changed, can copy all rows at once.
if (rowStride == m_rowStride) {
memcpy(tmp.data(), m_data.data(), m_rowStride * min(m_height, h) * sizeof(uint64_t));
} else if (m_width > 0 && m_height > 0) {
const uint32_t height = min(m_height, h);
for (uint32_t i = 0; i < height; i++)
memcpy(&tmp[i * rowStride], &m_data[i * m_rowStride], min(rowStride, m_rowStride) * sizeof(uint64_t));
}
tmp.moveTo(m_data);
}
m_width = w;
m_height = h;
m_rowStride = rowStride;
}
bool get(uint32_t x, uint32_t y) const {
XA_DEBUG_ASSERT(x < m_width && y < m_height);
const uint32_t index = (x >> 6) + y * m_rowStride;
return (m_data[index] & (UINT64_C(1) << (uint64_t(x) & UINT64_C(63)))) != 0;
}
void set(uint32_t x, uint32_t y) {
XA_DEBUG_ASSERT(x < m_width && y < m_height);
const uint32_t index = (x >> 6) + y * m_rowStride;
m_data[index] |= UINT64_C(1) << (uint64_t(x) & UINT64_C(63));
XA_DEBUG_ASSERT(get(x, y));
}
void zeroOutMemory() {
m_data.zeroOutMemory();
}
bool canBlit(const BitImage &image, uint32_t offsetX, uint32_t offsetY) const {
for (uint32_t y = 0; y < image.m_height; y++) {
const uint32_t thisY = y + offsetY;
if (thisY >= m_height)
continue;
uint32_t x = 0;
for (;;) {
const uint32_t thisX = x + offsetX;
if (thisX >= m_width)
break;
const uint32_t thisBlockShift = thisX % 64;
const uint64_t thisBlock = m_data[(thisX >> 6) + thisY * m_rowStride] >> thisBlockShift;
const uint32_t blockShift = x % 64;
const uint64_t block = image.m_data[(x >> 6) + y * image.m_rowStride] >> blockShift;
if ((thisBlock & block) != 0)
return false;
x += 64 - max(thisBlockShift, blockShift);
if (x >= image.m_width)
break;
}
}
return true;
}
void dilate(uint32_t padding) {
BitImage tmp(m_width, m_height);
for (uint32_t p = 0; p < padding; p++) {
tmp.zeroOutMemory();
for (uint32_t y = 0; y < m_height; y++) {
for (uint32_t x = 0; x < m_width; x++) {
bool b = get(x, y);
if (!b) {
if (x > 0) {
b |= get(x - 1, y);
if (y > 0)
b |= get(x - 1, y - 1);
if (y < m_height - 1)
b |= get(x - 1, y + 1);
}
if (y > 0)
b |= get(x, y - 1);
if (y < m_height - 1)
b |= get(x, y + 1);
if (x < m_width - 1) {
b |= get(x + 1, y);
if (y > 0)
b |= get(x + 1, y - 1);
if (y < m_height - 1)
b |= get(x + 1, y + 1);
}
}
if (b)
tmp.set(x, y);
}
}
tmp.m_data.copyTo(m_data);
}
}
private:
uint32_t m_width;
uint32_t m_height;
uint32_t m_rowStride; // In uint64_t's
Array<uint64_t> m_data;
};
// From Fast-BVH
class BVH {
public:
BVH(const Array<AABB> &objectAabbs, uint32_t leafSize = 4) :
m_objectIds(MemTag::BVH), m_nodes(MemTag::BVH) {
m_objectAabbs = &objectAabbs;
if (m_objectAabbs->isEmpty())
return;
m_objectIds.resize(objectAabbs.size());
for (uint32_t i = 0; i < m_objectIds.size(); i++)
m_objectIds[i] = i;
BuildEntry todo[128];
uint32_t stackptr = 0;
const uint32_t kRoot = 0xfffffffc;
const uint32_t kUntouched = 0xffffffff;
const uint32_t kTouchedTwice = 0xfffffffd;
// Push the root
todo[stackptr].start = 0;
todo[stackptr].end = objectAabbs.size();
todo[stackptr].parent = kRoot;
stackptr++;
Node node;
m_nodes.reserve(objectAabbs.size() * 2);
uint32_t nNodes = 0;
while (stackptr > 0) {
// Pop the next item off of the stack
const BuildEntry &bnode = todo[--stackptr];
const uint32_t start = bnode.start;
const uint32_t end = bnode.end;
const uint32_t nPrims = end - start;
nNodes++;
node.start = start;
node.nPrims = nPrims;
node.rightOffset = kUntouched;
// Calculate the bounding box for this node
AABB bb(objectAabbs[m_objectIds[start]]);
AABB bc(objectAabbs[m_objectIds[start]].centroid());
for (uint32_t p = start + 1; p < end; ++p) {
bb.expandToInclude(objectAabbs[m_objectIds[p]]);
bc.expandToInclude(objectAabbs[m_objectIds[p]].centroid());
}
node.aabb = bb;
// If the number of primitives at this point is less than the leaf
// size, then this will become a leaf. (Signified by rightOffset == 0)
if (nPrims <= leafSize)
node.rightOffset = 0;
m_nodes.push_back(node);
// Child touches parent...
// Special case: Don't do this for the root.
if (bnode.parent != kRoot) {
m_nodes[bnode.parent].rightOffset--;
// When this is the second touch, this is the right child.
// The right child sets up the offset for the flat tree.
if (m_nodes[bnode.parent].rightOffset == kTouchedTwice)
m_nodes[bnode.parent].rightOffset = nNodes - 1 - bnode.parent;
}
// If this is a leaf, no need to subdivide.
if (node.rightOffset == 0)
continue;
// Set the split dimensions
const uint32_t split_dim = bc.maxDimension();
// Split on the center of the longest axis
const float split_coord = 0.5f * ((&bc.min.x)[split_dim] + (&bc.max.x)[split_dim]);
// Partition the list of objects on this split
uint32_t mid = start;
for (uint32_t i = start; i < end; ++i) {
const Vector3 centroid(objectAabbs[m_objectIds[i]].centroid());
if ((&centroid.x)[split_dim] < split_coord) {
swap(m_objectIds[i], m_objectIds[mid]);
++mid;
}
}
// If we get a bad split, just choose the center...
if (mid == start || mid == end)
mid = start + (end - start) / 2;
// Push right child
todo[stackptr].start = mid;
todo[stackptr].end = end;
todo[stackptr].parent = nNodes - 1;
stackptr++;
// Push left child
todo[stackptr].start = start;
todo[stackptr].end = mid;
todo[stackptr].parent = nNodes - 1;
stackptr++;
}
}
void query(const AABB &queryAabb, Array<uint32_t> &result) const {
result.clear();
// Working set
uint32_t todo[64];
int32_t stackptr = 0;
// "Push" on the root node to the working set
todo[stackptr] = 0;
while (stackptr >= 0) {
// Pop off the next node to work on.
const int ni = todo[stackptr--];
const Node &node = m_nodes[ni];
// Is leaf -> Intersect
if (node.rightOffset == 0) {
for (uint32_t o = 0; o < node.nPrims; ++o) {
const uint32_t obj = node.start + o;
if (queryAabb.intersect((*m_objectAabbs)[m_objectIds[obj]]))
result.push_back(m_objectIds[obj]);
}
} else { // Not a leaf
const uint32_t left = ni + 1;
const uint32_t right = ni + node.rightOffset;
if (queryAabb.intersect(m_nodes[left].aabb))
todo[++stackptr] = left;
if (queryAabb.intersect(m_nodes[right].aabb))
todo[++stackptr] = right;
}
}
}
private:
struct BuildEntry {
uint32_t parent; // If non-zero then this is the index of the parent. (used in offsets)
uint32_t start, end; // The range of objects in the object list covered by this node.
};
struct Node {
AABB aabb;
uint32_t start, nPrims, rightOffset;
};
const Array<AABB> *m_objectAabbs;
Array<uint32_t> m_objectIds;
Array<Node> m_nodes;
};
struct Fit {
static bool computeBasis(ConstArrayView<Vector3> points, Basis *basis) {
if (computeLeastSquaresNormal(points, &basis->normal)) {
basis->tangent = Basis::computeTangent(basis->normal);
basis->bitangent = Basis::computeBitangent(basis->normal, basis->tangent);
return true;
}
return computeEigen(points, basis);
}
private:
// Fit a plane to a collection of points.
// Fast, and accurate to within a few degrees.
// Returns None if the points do not span a plane.
// https://www.ilikebigbits.com/2015_03_04_plane_from_points.html
static bool computeLeastSquaresNormal(ConstArrayView<Vector3> points, Vector3 *normal) {
XA_DEBUG_ASSERT(points.length >= 3);
if (points.length == 3) {
*normal = normalize(cross(points[2] - points[0], points[1] - points[0]));
return true;
}
const float invN = 1.0f / float(points.length);
Vector3 centroid(0.0f);
for (uint32_t i = 0; i < points.length; i++)
centroid += points[i];
centroid *= invN;
// Calculate full 3x3 covariance matrix, excluding symmetries:
float xx = 0.0f, xy = 0.0f, xz = 0.0f, yy = 0.0f, yz = 0.0f, zz = 0.0f;
for (uint32_t i = 0; i < points.length; i++) {
Vector3 r = points[i] - centroid;
xx += r.x * r.x;
xy += r.x * r.y;
xz += r.x * r.z;
yy += r.y * r.y;
yz += r.y * r.z;
zz += r.z * r.z;
}
#if 0
xx *= invN;
xy *= invN;
xz *= invN;
yy *= invN;
yz *= invN;
zz *= invN;
Vector3 weighted_dir(0.0f);
{
float det_x = yy * zz - yz * yz;
const Vector3 axis_dir(det_x, xz * yz - xy * zz, xy * yz - xz * yy);
float weight = det_x * det_x;
if (dot(weighted_dir, axis_dir) < 0.0f)
weight = -weight;
weighted_dir += axis_dir * weight;
}
{
float det_y = xx * zz - xz * xz;
const Vector3 axis_dir(xz * yz - xy * zz, det_y, xy * xz - yz * xx);
float weight = det_y * det_y;
if (dot(weighted_dir, axis_dir) < 0.0f)
weight = -weight;
weighted_dir += axis_dir * weight;
}
{
float det_z = xx * yy - xy * xy;
const Vector3 axis_dir(xy * yz - xz * yy, xy * xz - yz * xx, det_z);
float weight = det_z * det_z;
if (dot(weighted_dir, axis_dir) < 0.0f)
weight = -weight;
weighted_dir += axis_dir * weight;
}
*normal = normalize(weighted_dir, kEpsilon);
#else
const float det_x = yy * zz - yz * yz;
const float det_y = xx * zz - xz * xz;
const float det_z = xx * yy - xy * xy;
const float det_max = max(det_x, max(det_y, det_z));
if (det_max <= 0.0f)
return false; // The points don't span a plane
// Pick path with best conditioning:
Vector3 dir(0.0f);
if (det_max == det_x)
dir = Vector3(det_x, xz * yz - xy * zz, xy * yz - xz * yy);
else if (det_max == det_y)
dir = Vector3(xz * yz - xy * zz, det_y, xy * xz - yz * xx);
else if (det_max == det_z)
dir = Vector3(xy * yz - xz * yy, xy * xz - yz * xx, det_z);
const float len = length(dir);
if (isZero(len, kEpsilon))
return false;
*normal = dir * (1.0f / len);
#endif
return isNormalized(*normal);
}
static bool computeEigen(ConstArrayView<Vector3> points, Basis *basis) {
float matrix[6];
computeCovariance(points, matrix);
if (matrix[0] == 0 && matrix[3] == 0 && matrix[5] == 0)
return false;
float eigenValues[3];
Vector3 eigenVectors[3];
if (!eigenSolveSymmetric3(matrix, eigenValues, eigenVectors))
return false;
basis->normal = normalize(eigenVectors[2]);
basis->tangent = normalize(eigenVectors[0]);
basis->bitangent = normalize(eigenVectors[1]);
return true;
}
static Vector3 computeCentroid(ConstArrayView<Vector3> points) {
Vector3 centroid(0.0f);
for (uint32_t i = 0; i < points.length; i++)
centroid += points[i];
centroid /= float(points.length);
return centroid;
}
static Vector3 computeCovariance(ConstArrayView<Vector3> points, float *covariance) {
// compute the centroid
Vector3 centroid = computeCentroid(points);
// compute covariance matrix
for (int i = 0; i < 6; i++) {
covariance[i] = 0.0f;
}
for (uint32_t i = 0; i < points.length; i++) {
Vector3 v = points[i] - centroid;
covariance[0] += v.x * v.x;
covariance[1] += v.x * v.y;
covariance[2] += v.x * v.z;
covariance[3] += v.y * v.y;
covariance[4] += v.y * v.z;
covariance[5] += v.z * v.z;
}
return centroid;
}
// Tridiagonal solver from Charles Bloom.
// Householder transforms followed by QL decomposition.
// Seems to be based on the code from Numerical Recipes in C.
static bool eigenSolveSymmetric3(const float matrix[6], float eigenValues[3], Vector3 eigenVectors[3]) {
XA_DEBUG_ASSERT(matrix != nullptr && eigenValues != nullptr && eigenVectors != nullptr);
float subd[3];
float diag[3];
float work[3][3];
work[0][0] = matrix[0];
work[0][1] = work[1][0] = matrix[1];
work[0][2] = work[2][0] = matrix[2];
work[1][1] = matrix[3];
work[1][2] = work[2][1] = matrix[4];
work[2][2] = matrix[5];
EigenSolver3_Tridiagonal(work, diag, subd);
if (!EigenSolver3_QLAlgorithm(work, diag, subd)) {
for (int i = 0; i < 3; i++) {
eigenValues[i] = 0;
eigenVectors[i] = Vector3(0);
}
return false;
}
for (int i = 0; i < 3; i++) {
eigenValues[i] = (float)diag[i];
}
// eigenvectors are the columns; make them the rows :
for (int i = 0; i < 3; i++) {
for (int j = 0; j < 3; j++) {
(&eigenVectors[j].x)[i] = (float)work[i][j];
}
}
// shuffle to sort by singular value :
if (eigenValues[2] > eigenValues[0] && eigenValues[2] > eigenValues[1]) {
swap(eigenValues[0], eigenValues[2]);
swap(eigenVectors[0], eigenVectors[2]);
}
if (eigenValues[1] > eigenValues[0]) {
swap(eigenValues[0], eigenValues[1]);
swap(eigenVectors[0], eigenVectors[1]);
}
if (eigenValues[2] > eigenValues[1]) {
swap(eigenValues[1], eigenValues[2]);
swap(eigenVectors[1], eigenVectors[2]);
}
XA_DEBUG_ASSERT(eigenValues[0] >= eigenValues[1] && eigenValues[0] >= eigenValues[2]);
XA_DEBUG_ASSERT(eigenValues[1] >= eigenValues[2]);
return true;
}
private:
static void EigenSolver3_Tridiagonal(float mat[3][3], float *diag, float *subd) {
// Householder reduction T = Q^t M Q
// Input:
// mat, symmetric 3x3 matrix M
// Output:
// mat, orthogonal matrix Q
// diag, diagonal entries of T
// subd, subdiagonal entries of T (T is symmetric)
const float epsilon = 1e-08f;
float a = mat[0][0];
float b = mat[0][1];
float c = mat[0][2];
float d = mat[1][1];
float e = mat[1][2];
float f = mat[2][2];
diag[0] = a;
subd[2] = 0.f;
if (fabsf(c) >= epsilon) {
const float ell = sqrtf(b * b + c * c);
b /= ell;
c /= ell;
const float q = 2 * b * e + c * (f - d);
diag[1] = d + c * q;
diag[2] = f - c * q;
subd[0] = ell;
subd[1] = e - b * q;
mat[0][0] = 1;
mat[0][1] = 0;
mat[0][2] = 0;
mat[1][0] = 0;
mat[1][1] = b;
mat[1][2] = c;
mat[2][0] = 0;
mat[2][1] = c;
mat[2][2] = -b;
} else {
diag[1] = d;
diag[2] = f;
subd[0] = b;
subd[1] = e;
mat[0][0] = 1;
mat[0][1] = 0;
mat[0][2] = 0;
mat[1][0] = 0;
mat[1][1] = 1;
mat[1][2] = 0;
mat[2][0] = 0;
mat[2][1] = 0;
mat[2][2] = 1;
}
}
static bool EigenSolver3_QLAlgorithm(float mat[3][3], float *diag, float *subd) {
// QL iteration with implicit shifting to reduce matrix from tridiagonal
// to diagonal
const int maxiter = 32;
for (int ell = 0; ell < 3; ell++) {
int iter;
for (iter = 0; iter < maxiter; iter++) {
int m;
for (m = ell; m <= 1; m++) {
float dd = fabsf(diag[m]) + fabsf(diag[m + 1]);
if (fabsf(subd[m]) + dd == dd)
break;
}
if (m == ell)
break;
float g = (diag[ell + 1] - diag[ell]) / (2 * subd[ell]);
float r = sqrtf(g * g + 1);
if (g < 0)
g = diag[m] - diag[ell] + subd[ell] / (g - r);
else
g = diag[m] - diag[ell] + subd[ell] / (g + r);
float s = 1, c = 1, p = 0;
for (int i = m - 1; i >= ell; i--) {
float f = s * subd[i], b = c * subd[i];
if (fabsf(f) >= fabsf(g)) {
c = g / f;
r = sqrtf(c * c + 1);
subd[i + 1] = f * r;
c *= (s = 1 / r);
} else {
s = f / g;
r = sqrtf(s * s + 1);
subd[i + 1] = g * r;
s *= (c = 1 / r);
}
g = diag[i + 1] - p;
r = (diag[i] - g) * s + 2 * b * c;
p = s * r;
diag[i + 1] = g + p;
g = c * r - b;
for (int k = 0; k < 3; k++) {
f = mat[k][i + 1];
mat[k][i + 1] = s * mat[k][i] + c * f;
mat[k][i] = c * mat[k][i] - s * f;
}
}
diag[ell] -= p;
subd[ell] = g;
subd[m] = 0;
}
if (iter == maxiter)
// should not get here under normal circumstances
return false;
}
return true;
}
};
static uint32_t sdbmHash(const void *data_in, uint32_t size, uint32_t h = 5381) {
const uint8_t *data = (const uint8_t *)data_in;
uint32_t i = 0;
while (i < size) {
h = (h << 16) + (h << 6) - h + (uint32_t)data[i++];
}
return h;
}
template <typename T>
static uint32_t hash(const T &t, uint32_t h = 5381) {
return sdbmHash(&t, sizeof(T), h);
}
template <typename Key>
struct Hash {
uint32_t operator()(const Key &k) const { return hash(k); }
};
template <typename Key>
struct PassthroughHash {
uint32_t operator()(const Key &k) const { return (uint32_t)k; }
};
template <typename Key>
struct Equal {
bool operator()(const Key &k0, const Key &k1) const { return k0 == k1; }
};
template <typename Key, typename H = Hash<Key>, typename E = Equal<Key>>
class HashMap {
public:
HashMap(int memTag, uint32_t size) :
m_memTag(memTag), m_size(size), m_numSlots(0), m_slots(nullptr), m_keys(memTag), m_next(memTag) {
}
~HashMap() {
if (m_slots)
XA_FREE(m_slots);
}
void destroy() {
if (m_slots) {
XA_FREE(m_slots);
m_slots = nullptr;
}
m_keys.destroy();
m_next.destroy();
}
uint32_t add(const Key &key) {
if (!m_slots)
alloc();
const uint32_t hash = computeHash(key);
m_keys.push_back(key);
m_next.push_back(m_slots[hash]);
m_slots[hash] = m_next.size() - 1;
return m_keys.size() - 1;
}
uint32_t get(const Key &key) const {
if (!m_slots)
return UINT32_MAX;
return find(key, m_slots[computeHash(key)]);
}
uint32_t getNext(const Key &key, uint32_t current) const {
return find(key, m_next[current]);
}
private:
void alloc() {
XA_DEBUG_ASSERT(m_size > 0);
m_numSlots = nextPowerOfTwo(m_size);
auto minNumSlots = uint32_t(m_size * 1.3);
if (m_numSlots < minNumSlots)
m_numSlots = nextPowerOfTwo(minNumSlots);
m_slots = XA_ALLOC_ARRAY(m_memTag, uint32_t, m_numSlots);
for (uint32_t i = 0; i < m_numSlots; i++)
m_slots[i] = UINT32_MAX;
m_keys.reserve(m_size);
m_next.reserve(m_size);
}
uint32_t computeHash(const Key &key) const {
H hash;
return hash(key) & (m_numSlots - 1);
}
uint32_t find(const Key &key, uint32_t current) const {
E equal;
while (current != UINT32_MAX) {
if (equal(m_keys[current], key))
return current;
current = m_next[current];
}
return current;
}
int m_memTag;
uint32_t m_size;
uint32_t m_numSlots;
uint32_t *m_slots;
Array<Key> m_keys;
Array<uint32_t> m_next;
};
template <typename T>
static void insertionSort(T *data, uint32_t length) {
for (int32_t i = 1; i < (int32_t)length; i++) {
T x = data[i];
int32_t j = i - 1;
while (j >= 0 && x < data[j]) {
data[j + 1] = data[j];
j--;
}
data[j + 1] = x;
}
}
class KISSRng {
public:
KISSRng() { reset(); }
void reset() {
x = 123456789;
y = 362436000;
z = 521288629;
c = 7654321;
}
uint32_t getRange(uint32_t range) {
if (range == 0)
return 0;
x = 69069 * x + 12345;
y ^= (y << 13);
y ^= (y >> 17);
y ^= (y << 5);
uint64_t t = 698769069ULL * z + c;
c = (t >> 32);
return (x + y + (z = (uint32_t)t)) % (range + 1);
}
private:
uint32_t x, y, z, c;
};
// Based on Pierre Terdiman's and Michael Herf's source code.
// http://www.codercorner.com/RadixSortRevisited.htm
// http://www.stereopsis.com/radix.html
class RadixSort {
public:
void sort(ConstArrayView<float> input) {
if (input.length == 0) {
m_buffer1.clear();
m_buffer2.clear();
m_ranks = m_buffer1.data();
m_ranks2 = m_buffer2.data();
return;
}
// Resize lists if needed
m_buffer1.resize(input.length);
m_buffer2.resize(input.length);
m_ranks = m_buffer1.data();
m_ranks2 = m_buffer2.data();
m_validRanks = false;
if (input.length < 32)
insertionSort(input);
else {
// @@ Avoid touching the input multiple times.
for (uint32_t i = 0; i < input.length; i++) {
floatFlip((uint32_t &)input[i]);
}
radixSort(ConstArrayView<uint32_t>((const uint32_t *)input.data, input.length));
for (uint32_t i = 0; i < input.length; i++) {
ifloatFlip((uint32_t &)input[i]);
}
}
}
// Access to results. m_ranks is a list of indices in sorted order, i.e. in the order you may further process your data
const uint32_t *ranks() const {
XA_DEBUG_ASSERT(m_validRanks);
return m_ranks;
}
private:
uint32_t *m_ranks, *m_ranks2;
Array<uint32_t> m_buffer1, m_buffer2;
bool m_validRanks = false;
void floatFlip(uint32_t &f) {
int32_t mask = (int32_t(f) >> 31) | 0x80000000; // Warren Hunt, Manchor Ko.
f ^= mask;
}
void ifloatFlip(uint32_t &f) {
uint32_t mask = ((f >> 31) - 1) | 0x80000000; // Michael Herf.
f ^= mask;
}
void createHistograms(ConstArrayView<uint32_t> input, uint32_t *histogram) {
const uint32_t bucketCount = sizeof(uint32_t);
// Init bucket pointers.
uint32_t *h[bucketCount];
for (uint32_t i = 0; i < bucketCount; i++) {
h[i] = histogram + 256 * i;
}
// Clear histograms.
memset(histogram, 0, 256 * bucketCount * sizeof(uint32_t));
// @@ Add support for signed integers.
// Build histograms.
const uint8_t *p = (const uint8_t *)input.data; // @@ Does this break aliasing rules?
const uint8_t *pe = p + input.length * sizeof(uint32_t);
while (p != pe) {
h[0][*p++]++, h[1][*p++]++, h[2][*p++]++, h[3][*p++]++;
}
}
void insertionSort(ConstArrayView<float> input) {
if (!m_validRanks) {
m_ranks[0] = 0;
for (uint32_t i = 1; i != input.length; ++i) {
int rank = m_ranks[i] = i;
uint32_t j = i;
while (j != 0 && input[rank] < input[m_ranks[j - 1]]) {
m_ranks[j] = m_ranks[j - 1];
--j;
}
if (i != j) {
m_ranks[j] = rank;
}
}
m_validRanks = true;
} else {
for (uint32_t i = 1; i != input.length; ++i) {
int rank = m_ranks[i];
uint32_t j = i;
while (j != 0 && input[rank] < input[m_ranks[j - 1]]) {
m_ranks[j] = m_ranks[j - 1];
--j;
}
if (i != j) {
m_ranks[j] = rank;
}
}
}
}
void radixSort(ConstArrayView<uint32_t> input) {
const uint32_t P = sizeof(uint32_t); // pass count
// Allocate histograms & offsets on the stack
uint32_t histogram[256 * P];
uint32_t *link[256];
createHistograms(input, histogram);
// Radix sort, j is the pass number (0=LSB, P=MSB)
for (uint32_t j = 0; j < P; j++) {
// Pointer to this bucket.
const uint32_t *h = &histogram[j * 256];
auto inputBytes = (const uint8_t *)input.data; // @@ Is this aliasing legal?
inputBytes += j;
if (h[inputBytes[0]] == input.length) {
// Skip this pass, all values are the same.
continue;
}
// Create offsets
link[0] = m_ranks2;
for (uint32_t i = 1; i < 256; i++)
link[i] = link[i - 1] + h[i - 1];
// Perform Radix Sort
if (!m_validRanks) {
for (uint32_t i = 0; i < input.length; i++) {
*link[inputBytes[i * P]]++ = i;
}
m_validRanks = true;
} else {
for (uint32_t i = 0; i < input.length; i++) {
const uint32_t idx = m_ranks[i];
*link[inputBytes[idx * P]]++ = idx;
}
}
// Swap pointers for next pass. Valid indices - the most recent ones - are in m_ranks after the swap.
swap(m_ranks, m_ranks2);
}
// All values were equal, generate linear ranks.
if (!m_validRanks) {
for (uint32_t i = 0; i < input.length; i++)
m_ranks[i] = i;
m_validRanks = true;
}
}
};
// Wrapping this in a class allows temporary arrays to be re-used.
class BoundingBox2D {
public:
Vector2 majorAxis, minorAxis, minCorner, maxCorner;
void clear() {
m_boundaryVertices.clear();
}
void appendBoundaryVertex(Vector2 v) {
m_boundaryVertices.push_back(v);
}
// This should compute convex hull and use rotating calipers to find the best box. Currently it uses a brute force method.
// If vertices are empty, the boundary vertices are used.
void compute(ConstArrayView<Vector2> vertices = ConstArrayView<Vector2>()) {
//XA_DEBUG_ASSERT(!m_boundaryVertices.isEmpty());
if (m_boundaryVertices.isEmpty()) {
return;
}
if (vertices.length == 0)
vertices = m_boundaryVertices;
convexHull(m_boundaryVertices, m_hull, 0.00001f);
// @@ Ideally I should use rotating calipers to find the best box. Using brute force for now.
float best_area = FLT_MAX;
Vector2 best_min(0);
Vector2 best_max(0);
Vector2 best_axis(0);
const uint32_t hullCount = m_hull.size();
for (uint32_t i = 0, j = hullCount - 1; i < hullCount; j = i, i++) {
if (equal(m_hull[i], m_hull[j], kEpsilon))
continue;
Vector2 axis = normalize(m_hull[i] - m_hull[j]);
XA_DEBUG_ASSERT(isFinite(axis));
// Compute bounding box.
Vector2 box_min(FLT_MAX, FLT_MAX);
Vector2 box_max(-FLT_MAX, -FLT_MAX);
// Consider all points, not only boundary points, in case the input chart is malformed.
for (uint32_t v = 0; v < vertices.length; v++) {
const Vector2 &point = vertices[v];
const float x = dot(axis, point);
const float y = dot(Vector2(-axis.y, axis.x), point);
box_min.x = min(box_min.x, x);
box_max.x = max(box_max.x, x);
box_min.y = min(box_min.y, y);
box_max.y = max(box_max.y, y);
}
// Compute box area.
const float area = (box_max.x - box_min.x) * (box_max.y - box_min.y);
if (area < best_area) {
best_area = area;
best_min = box_min;
best_max = box_max;
best_axis = axis;
}
}
majorAxis = best_axis;
minorAxis = Vector2(-best_axis.y, best_axis.x);
minCorner = best_min;
maxCorner = best_max;
XA_ASSERT(isFinite(majorAxis) && isFinite(minorAxis) && isFinite(minCorner));
}
private:
// Compute the convex hull using Graham Scan.
void convexHull(ConstArrayView<Vector2> input, Array<Vector2> &output, float epsilon) {
m_coords.resize(input.length);
for (uint32_t i = 0; i < input.length; i++)
m_coords[i] = input[i].x;
m_radix.sort(m_coords);
const uint32_t *ranks = m_radix.ranks();
m_top.clear();
m_bottom.clear();
m_top.reserve(input.length);
m_bottom.reserve(input.length);
Vector2 P = input[ranks[0]];
Vector2 Q = input[ranks[input.length - 1]];
float topy = max(P.y, Q.y);
float boty = min(P.y, Q.y);
for (uint32_t i = 0; i < input.length; i++) {
Vector2 p = input[ranks[i]];
if (p.y >= boty)
m_top.push_back(p);
}
for (uint32_t i = 0; i < input.length; i++) {
Vector2 p = input[ranks[input.length - 1 - i]];
if (p.y <= topy)
m_bottom.push_back(p);
}
// Filter top list.
output.clear();
XA_DEBUG_ASSERT(m_top.size() >= 2);
output.push_back(m_top[0]);
output.push_back(m_top[1]);
for (uint32_t i = 2; i < m_top.size();) {
Vector2 a = output[output.size() - 2];
Vector2 b = output[output.size() - 1];
Vector2 c = m_top[i];
float area = triangleArea(a, b, c);
if (area >= -epsilon)
output.pop_back();
if (area < -epsilon || output.size() == 1) {
output.push_back(c);
i++;
}
}
uint32_t top_count = output.size();
XA_DEBUG_ASSERT(m_bottom.size() >= 2);
output.push_back(m_bottom[1]);
// Filter bottom list.
for (uint32_t i = 2; i < m_bottom.size();) {
Vector2 a = output[output.size() - 2];
Vector2 b = output[output.size() - 1];
Vector2 c = m_bottom[i];
float area = triangleArea(a, b, c);
if (area >= -epsilon)
output.pop_back();
if (area < -epsilon || output.size() == top_count) {
output.push_back(c);
i++;
}
}
// Remove duplicate element.
XA_DEBUG_ASSERT(output.size() > 0);
output.pop_back();
}
Array<Vector2> m_boundaryVertices;
Array<float> m_coords;
Array<Vector2> m_top, m_bottom, m_hull;
RadixSort m_radix;
};
struct EdgeKey {
EdgeKey(const EdgeKey &k) :
v0(k.v0), v1(k.v1) {}
EdgeKey(uint32_t _v0, uint32_t _v1) :
v0(_v0), v1(_v1) {}
bool operator==(const EdgeKey &k) const { return v0 == k.v0 && v1 == k.v1; }
uint32_t v0;
uint32_t v1;
};
struct EdgeHash {
uint32_t operator()(const EdgeKey &k) const { return k.v0 * 32768u + k.v1; }
};
static uint32_t meshEdgeFace(uint32_t edge) {
return edge / 3;
}
static uint32_t meshEdgeIndex0(uint32_t edge) {
return edge;
}
static uint32_t meshEdgeIndex1(uint32_t edge) {
const uint32_t faceFirstEdge = edge / 3 * 3;
return faceFirstEdge + (edge - faceFirstEdge + 1) % 3;
}
struct MeshFlags {
enum {
HasIgnoredFaces = 1 << 0,
HasNormals = 1 << 1,
HasMaterials = 1 << 2
};
};
class Mesh {
public:
Mesh(float epsilon, uint32_t approxVertexCount, uint32_t approxFaceCount, uint32_t flags = 0, uint32_t id = UINT32_MAX) :
m_epsilon(epsilon), m_flags(flags), m_id(id), m_faceIgnore(MemTag::Mesh), m_faceMaterials(MemTag::Mesh), m_indices(MemTag::MeshIndices), m_positions(MemTag::MeshPositions), m_normals(MemTag::MeshNormals), m_texcoords(MemTag::MeshTexcoords), m_boundaryEdges(MemTag::MeshBoundaries), m_oppositeEdges(MemTag::MeshBoundaries), m_edgeMap(MemTag::MeshEdgeMap, approxFaceCount * 3) {
m_indices.reserve(approxFaceCount * 3);
m_positions.reserve(approxVertexCount);
m_texcoords.reserve(approxVertexCount);
if (m_flags & MeshFlags::HasIgnoredFaces)
m_faceIgnore.reserve(approxFaceCount);
if (m_flags & MeshFlags::HasNormals)
m_normals.reserve(approxVertexCount);
if (m_flags & MeshFlags::HasMaterials)
m_faceMaterials.reserve(approxFaceCount);
}
uint32_t flags() const { return m_flags; }
uint32_t id() const { return m_id; }
void addVertex(const Vector3 &pos, const Vector3 &normal = Vector3(0.0f), const Vector2 &texcoord = Vector2(0.0f)) {
XA_DEBUG_ASSERT(isFinite(pos));
m_positions.push_back(pos);
if (m_flags & MeshFlags::HasNormals)
m_normals.push_back(normal);
m_texcoords.push_back(texcoord);
}
void addFace(const uint32_t *indices, bool ignore = false, uint32_t material = UINT32_MAX) {
if (m_flags & MeshFlags::HasIgnoredFaces)
m_faceIgnore.push_back(ignore);
if (m_flags & MeshFlags::HasMaterials)
m_faceMaterials.push_back(material);
const uint32_t firstIndex = m_indices.size();
for (uint32_t i = 0; i < 3; i++)
m_indices.push_back(indices[i]);
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex0 = m_indices[firstIndex + i];
const uint32_t vertex1 = m_indices[firstIndex + (i + 1) % 3];
m_edgeMap.add(EdgeKey(vertex0, vertex1));
}
}
void createBoundaries() {
const uint32_t edgeCount = m_indices.size();
const uint32_t vertexCount = m_positions.size();
m_oppositeEdges.resize(edgeCount);
m_boundaryEdges.reserve(uint32_t(edgeCount * 0.1f));
m_isBoundaryVertex.resize(vertexCount);
m_isBoundaryVertex.zeroOutMemory();
for (uint32_t i = 0; i < edgeCount; i++)
m_oppositeEdges[i] = UINT32_MAX;
const uint32_t faceCount = m_indices.size() / 3;
for (uint32_t i = 0; i < faceCount; i++) {
if (isFaceIgnored(i))
continue;
for (uint32_t j = 0; j < 3; j++) {
const uint32_t edge = i * 3 + j;
const uint32_t vertex0 = m_indices[edge];
const uint32_t vertex1 = m_indices[i * 3 + (j + 1) % 3];
// If there is an edge with opposite winding to this one, the edge isn't on a boundary. (orig)
//I have a boundary where vertices are not joined by indices -> they shouldnt be the same
//does xatlas merge verts?
const uint32_t oppositeEdge = findEdge(vertex1, vertex0);
if (oppositeEdge != UINT32_MAX) {
m_oppositeEdges[edge] = oppositeEdge;
} else {
m_boundaryEdges.push_back(edge);
m_isBoundaryVertex.set(vertex0);
m_isBoundaryVertex.set(vertex1);
}
}
}
}
void createBoundariesOriginal() {
const uint32_t edgeCount = m_indices.size();
const uint32_t vertexCount = m_positions.size();
m_oppositeEdges.resize(edgeCount);
m_boundaryEdges.reserve(uint32_t(edgeCount * 0.1f));
m_isBoundaryVertex.resize(vertexCount);
m_isBoundaryVertex.zeroOutMemory();
for (uint32_t i = 0; i < edgeCount; i++)
m_oppositeEdges[i] = UINT32_MAX;
const uint32_t faceCount = m_indices.size() / 3;
for (uint32_t i = 0; i < faceCount; i++) {
if (isFaceIgnored(i))
continue;
for (uint32_t j = 0; j < 3; j++) {
const uint32_t edge = i * 3 + j;
const uint32_t vertex0 = m_indices[edge];
const uint32_t vertex1 = m_indices[i * 3 + (j + 1) % 3];
// If there is an edge with opposite winding to this one, the edge isn't on a boundary.
const uint32_t oppositeEdge = findEdge(vertex1, vertex0);
if (oppositeEdge != UINT32_MAX) {
m_oppositeEdges[edge] = oppositeEdge;
} else {
m_boundaryEdges.push_back(edge);
m_isBoundaryVertex.set(vertex0);
m_isBoundaryVertex.set(vertex1);
}
}
}
}
/// Find edge, test all colocals.
uint32_t findEdge(uint32_t vertex0, uint32_t vertex1) const {
// Try to find exact vertex match first.
{
EdgeKey key(vertex0, vertex1);
uint32_t edge = m_edgeMap.get(key);
while (edge != UINT32_MAX) {
// Don't find edges of ignored faces.
if (!isFaceIgnored(meshEdgeFace(edge)))
return edge;
edge = m_edgeMap.getNext(key, edge);
}
}
return UINT32_MAX;
}
// Edge map can be destroyed when no longer used to reduce memory usage. It's used by:
// * Mesh::createBoundaries()
// * Mesh::edgeMap() (used by MeshFaceGroups)
void destroyEdgeMap() {
m_edgeMap.destroy();
}
#if XA_DEBUG_EXPORT_OBJ
void writeObjVertices(FILE *file) const {
for (uint32_t i = 0; i < m_positions.size(); i++)
fprintf(file, "v %g %g %g\n", m_positions[i].x, m_positions[i].y, m_positions[i].z);
if (m_flags & MeshFlags::HasNormals) {
for (uint32_t i = 0; i < m_normals.size(); i++)
fprintf(file, "vn %g %g %g\n", m_normals[i].x, m_normals[i].y, m_normals[i].z);
}
for (uint32_t i = 0; i < m_texcoords.size(); i++)
fprintf(file, "vt %g %g\n", m_texcoords[i].x, m_texcoords[i].y);
}
void writeObjFace(FILE *file, uint32_t face, uint32_t offset = 0) const {
fprintf(file, "f ");
for (uint32_t j = 0; j < 3; j++) {
const uint32_t index = m_indices[face * 3 + j] + 1 + offset; // 1-indexed
fprintf(file, "%d/%d/%d%c", index, index, index, j == 2 ? '\n' : ' ');
}
}
void writeObjBoundaryEges(FILE *file) const {
if (m_oppositeEdges.isEmpty())
return; // Boundaries haven't been created.
fprintf(file, "o boundary_edges\n");
for (uint32_t i = 0; i < edgeCount(); i++) {
if (m_oppositeEdges[i] != UINT32_MAX)
continue;
fprintf(file, "l %d %d\n", m_indices[meshEdgeIndex0(i)] + 1, m_indices[meshEdgeIndex1(i)] + 1); // 1-indexed
}
}
void writeObjFile(const char *filename) const {
FILE *file;
XA_FOPEN(file, filename, "w");
if (!file)
return;
writeObjVertices(file);
fprintf(file, "s off\n");
fprintf(file, "o object\n");
for (uint32_t i = 0; i < faceCount(); i++)
writeObjFace(file, i);
writeObjBoundaryEges(file);
fclose(file);
}
#endif
float computeSurfaceArea() const {
float area = 0;
for (uint32_t f = 0; f < faceCount(); f++)
area += computeFaceArea(f);
XA_DEBUG_ASSERT(area >= 0);
return area;
}
// Returned value is always positive, even if some triangles are flipped.
float computeParametricArea() const {
float area = 0;
for (uint32_t f = 0; f < faceCount(); f++)
area += fabsf(computeFaceParametricArea(f)); // May be negative, depends on texcoord winding.
return area;
}
float computeFaceArea(uint32_t face) const {
const Vector3 &p0 = m_positions[m_indices[face * 3 + 0]];
const Vector3 &p1 = m_positions[m_indices[face * 3 + 1]];
const Vector3 &p2 = m_positions[m_indices[face * 3 + 2]];
return length(cross(p1 - p0, p2 - p0)) * 0.5f;
}
Vector3 computeFaceCentroid(uint32_t face) const {
Vector3 sum(0.0f);
for (uint32_t i = 0; i < 3; i++)
sum += m_positions[m_indices[face * 3 + i]];
return sum / 3.0f;
}
// Average of the edge midpoints weighted by the edge length.
// I want a point inside the triangle, but closer to the cirumcenter.
Vector3 computeFaceCenter(uint32_t face) const {
const Vector3 &p0 = m_positions[m_indices[face * 3 + 0]];
const Vector3 &p1 = m_positions[m_indices[face * 3 + 1]];
const Vector3 &p2 = m_positions[m_indices[face * 3 + 2]];
const float l0 = length(p1 - p0);
const float l1 = length(p2 - p1);
const float l2 = length(p0 - p2);
const Vector3 m0 = (p0 + p1) * l0 / (l0 + l1 + l2);
const Vector3 m1 = (p1 + p2) * l1 / (l0 + l1 + l2);
const Vector3 m2 = (p2 + p0) * l2 / (l0 + l1 + l2);
return m0 + m1 + m2;
}
Vector3 computeFaceNormal(uint32_t face) const {
const Vector3 &p0 = m_positions[m_indices[face * 3 + 0]];
const Vector3 &p1 = m_positions[m_indices[face * 3 + 1]];
const Vector3 &p2 = m_positions[m_indices[face * 3 + 2]];
const Vector3 e0 = p2 - p0;
const Vector3 e1 = p1 - p0;
const Vector3 normalAreaScaled = cross(e0, e1);
return normalizeSafe(normalAreaScaled, Vector3(0, 0, 1));
}
float computeFaceParametricArea(uint32_t face) const {
const Vector2 &t0 = m_texcoords[m_indices[face * 3 + 0]];
const Vector2 &t1 = m_texcoords[m_indices[face * 3 + 1]];
const Vector2 &t2 = m_texcoords[m_indices[face * 3 + 2]];
return triangleArea(t0, t1, t2);
}
// @@ This is not exactly accurate, we should compare the texture coordinates...
bool isSeam(uint32_t edge) const {
const uint32_t oppositeEdge = m_oppositeEdges[edge];
if (oppositeEdge == UINT32_MAX)
return false; // boundary edge
const uint32_t e0 = meshEdgeIndex0(edge);
const uint32_t e1 = meshEdgeIndex1(edge);
const uint32_t oe0 = meshEdgeIndex0(oppositeEdge);
const uint32_t oe1 = meshEdgeIndex1(oppositeEdge);
return m_indices[e0] != m_indices[oe1] || m_indices[e1] != m_indices[oe0];
}
bool isTextureSeam(uint32_t edge) const {
const uint32_t oppositeEdge = m_oppositeEdges[edge];
if (oppositeEdge == UINT32_MAX)
return false; // boundary edge
const uint32_t e0 = meshEdgeIndex0(edge);
const uint32_t e1 = meshEdgeIndex1(edge);
const uint32_t oe0 = meshEdgeIndex0(oppositeEdge);
const uint32_t oe1 = meshEdgeIndex1(oppositeEdge);
return m_texcoords[m_indices[e0]] != m_texcoords[m_indices[oe1]] || m_texcoords[m_indices[e1]] != m_texcoords[m_indices[oe0]];
}
XA_INLINE float epsilon() const { return m_epsilon; }
XA_INLINE uint32_t edgeCount() const { return m_indices.size(); }
XA_INLINE uint32_t oppositeEdge(uint32_t edge) const { return m_oppositeEdges[edge]; }
XA_INLINE bool isBoundaryEdge(uint32_t edge) const { return m_oppositeEdges[edge] == UINT32_MAX; }
XA_INLINE const Array<uint32_t> &boundaryEdges() const { return m_boundaryEdges; }
XA_INLINE bool isBoundaryVertex(uint32_t vertex) const { return m_isBoundaryVertex.get(vertex); }
XA_INLINE uint32_t vertexCount() const { return m_positions.size(); }
XA_INLINE uint32_t vertexAt(uint32_t i) const { return m_indices[i]; }
XA_INLINE const Vector3 &position(uint32_t vertex) const { return m_positions[vertex]; }
XA_INLINE ConstArrayView<Vector3> positions() const { return m_positions; }
XA_INLINE const Vector3 &normal(uint32_t vertex) const {
XA_DEBUG_ASSERT(m_flags & MeshFlags::HasNormals);
return m_normals[vertex];
}
XA_INLINE const Vector2 &texcoord(uint32_t vertex) const { return m_texcoords[vertex]; }
XA_INLINE Vector2 &texcoord(uint32_t vertex) { return m_texcoords[vertex]; }
XA_INLINE const ConstArrayView<Vector2> texcoords() const { return m_texcoords; }
XA_INLINE ArrayView<Vector2> texcoords() { return m_texcoords; }
XA_INLINE uint32_t faceCount() const { return m_indices.size() / 3; }
XA_INLINE ConstArrayView<uint32_t> indices() const { return m_indices; }
XA_INLINE uint32_t indexCount() const { return m_indices.size(); }
XA_INLINE bool isFaceIgnored(uint32_t face) const { return (m_flags & MeshFlags::HasIgnoredFaces) && m_faceIgnore[face]; }
XA_INLINE uint32_t faceMaterial(uint32_t face) const { return (m_flags & MeshFlags::HasMaterials) ? m_faceMaterials[face] : UINT32_MAX; }
XA_INLINE const HashMap<EdgeKey, EdgeHash> &edgeMap() const { return m_edgeMap; }
private:
float m_epsilon;
uint32_t m_flags;
uint32_t m_id;
Array<bool> m_faceIgnore;
Array<uint32_t> m_faceMaterials;
Array<uint32_t> m_indices;
Array<Vector3> m_positions;
Array<Vector3> m_normals;
Array<Vector2> m_texcoords;
// Populated by createBoundaries
BitArray m_isBoundaryVertex;
Array<uint32_t> m_boundaryEdges;
Array<uint32_t> m_oppositeEdges; // In: edge index. Out: the index of the opposite edge (i.e. wound the opposite direction). UINT32_MAX if the input edge is a boundary edge.
HashMap<EdgeKey, EdgeHash> m_edgeMap;
public:
class FaceEdgeIterator {
public:
FaceEdgeIterator(const Mesh *mesh, uint32_t face) :
m_mesh(mesh), m_face(face), m_relativeEdge(0) {
m_edge = m_face * 3;
}
void advance() {
if (m_relativeEdge < 3) {
m_edge++;
m_relativeEdge++;
}
}
bool isDone() const {
return m_relativeEdge == 3;
}
bool isBoundary() const { return m_mesh->m_oppositeEdges[m_edge] == UINT32_MAX; }
bool isSeam() const { return m_mesh->isSeam(m_edge); }
bool isTextureSeam() const { return m_mesh->isTextureSeam(m_edge); }
uint32_t edge() const { return m_edge; }
uint32_t relativeEdge() const { return m_relativeEdge; }
uint32_t face() const { return m_face; }
uint32_t oppositeEdge() const { return m_mesh->m_oppositeEdges[m_edge]; }
uint32_t oppositeFace() const {
const uint32_t oedge = m_mesh->m_oppositeEdges[m_edge];
if (oedge == UINT32_MAX)
return UINT32_MAX;
return meshEdgeFace(oedge);
}
uint32_t vertex0() const { return m_mesh->m_indices[m_face * 3 + m_relativeEdge]; }
uint32_t vertex1() const { return m_mesh->m_indices[m_face * 3 + (m_relativeEdge + 1) % 3]; }
const Vector3 &position0() const { return m_mesh->m_positions[vertex0()]; }
const Vector3 &position1() const { return m_mesh->m_positions[vertex1()]; }
const Vector3 &normal0() const { return m_mesh->m_normals[vertex0()]; }
const Vector3 &normal1() const { return m_mesh->m_normals[vertex1()]; }
const Vector2 &texcoord0() const { return m_mesh->m_texcoords[vertex0()]; }
const Vector2 &texcoord1() const { return m_mesh->m_texcoords[vertex1()]; }
private:
const Mesh *m_mesh;
uint32_t m_face;
uint32_t m_edge;
uint32_t m_relativeEdge;
};
};
struct MeshFaceGroups {
typedef uint32_t Handle;
static constexpr Handle kInvalid = UINT32_MAX;
MeshFaceGroups(const Mesh *mesh) :
m_mesh(mesh), m_groups(MemTag::Mesh), m_firstFace(MemTag::Mesh), m_nextFace(MemTag::Mesh), m_faceCount(MemTag::Mesh) {}
XA_INLINE Handle groupAt(uint32_t face) const { return m_groups[face]; }
XA_INLINE uint32_t groupCount() const { return m_faceCount.size(); }
XA_INLINE uint32_t nextFace(uint32_t face) const { return m_nextFace[face]; }
XA_INLINE uint32_t faceCount(uint32_t group) const { return m_faceCount[group]; }
void compute() {
m_groups.resize(m_mesh->faceCount());
m_groups.fillBytes(0xff); // Set all faces to kInvalid
uint32_t firstUnassignedFace = 0;
Handle group = 0;
Array<uint32_t> growFaces;
const uint32_t n = m_mesh->faceCount();
m_nextFace.resize(n);
for (;;) {
// Find an unassigned face.
uint32_t face = UINT32_MAX;
for (uint32_t f = firstUnassignedFace; f < n; f++) {
if (m_groups[f] == kInvalid && !m_mesh->isFaceIgnored(f)) {
face = f;
firstUnassignedFace = f + 1;
break;
}
}
if (face == UINT32_MAX)
break; // All faces assigned to a group (except ignored faces).
m_groups[face] = group;
m_nextFace[face] = UINT32_MAX;
m_firstFace.push_back(face);
growFaces.clear();
growFaces.push_back(face);
uint32_t prevFace = face, groupFaceCount = 1;
// Find faces connected to the face and assign them to the same group as the face, unless they are already assigned to another group.
for (;;) {
if (growFaces.isEmpty())
break;
const uint32_t f = growFaces.back();
growFaces.pop_back();
const uint32_t material = m_mesh->faceMaterial(f);
for (Mesh::FaceEdgeIterator edgeIt(m_mesh, f); !edgeIt.isDone(); edgeIt.advance()) {
const uint32_t oppositeEdge = m_mesh->findEdge(edgeIt.vertex1(), edgeIt.vertex0());
if (oppositeEdge == UINT32_MAX)
continue; // Boundary edge.
const uint32_t oppositeFace = meshEdgeFace(oppositeEdge);
if (m_mesh->isFaceIgnored(oppositeFace))
continue; // Don't add ignored faces to group.
if (m_mesh->faceMaterial(oppositeFace) != material)
continue; // Different material.
if (m_groups[oppositeFace] != kInvalid)
continue; // Connected face is already assigned to another group.
m_groups[oppositeFace] = group;
m_nextFace[oppositeFace] = UINT32_MAX;
if (prevFace != UINT32_MAX)
m_nextFace[prevFace] = oppositeFace;
prevFace = oppositeFace;
groupFaceCount++;
growFaces.push_back(oppositeFace);
}
}
m_faceCount.push_back(groupFaceCount);
group++;
XA_ASSERT(group < kInvalid);
}
}
class Iterator {
public:
Iterator(const MeshFaceGroups *meshFaceGroups, Handle group) :
m_meshFaceGroups(meshFaceGroups) {
XA_DEBUG_ASSERT(group != kInvalid);
m_current = m_meshFaceGroups->m_firstFace[group];
}
void advance() {
m_current = m_meshFaceGroups->m_nextFace[m_current];
}
bool isDone() const {
return m_current == UINT32_MAX;
}
uint32_t face() const {
return m_current;
}
private:
const MeshFaceGroups *m_meshFaceGroups;
uint32_t m_current;
};
private:
const Mesh *m_mesh;
Array<Handle> m_groups;
Array<uint32_t> m_firstFace;
Array<uint32_t> m_nextFace; // In: face. Out: the next face in the same group.
Array<uint32_t> m_faceCount; // In: face group. Out: number of faces in the group.
};
constexpr MeshFaceGroups::Handle MeshFaceGroups::kInvalid;
#if XA_CHECK_T_JUNCTIONS
static bool lineIntersectsPoint(const Vector3 &point, const Vector3 &lineStart, const Vector3 &lineEnd, float *t, float epsilon) {
float tt;
if (!t)
t = &tt;
*t = 0.0f;
if (equal(lineStart, point, epsilon) || equal(lineEnd, point, epsilon))
return false; // Vertex lies on either line vertices.
const Vector3 v01 = point - lineStart;
const Vector3 v21 = lineEnd - lineStart;
const float l = length(v21);
const float d = length(cross(v01, v21)) / l;
if (!isZero(d, epsilon))
return false;
*t = dot(v01, v21) / (l * l);
return *t > kEpsilon && *t < 1.0f - kEpsilon;
}
// Returns the number of T-junctions found.
static int meshCheckTJunctions(const Mesh &inputMesh) {
int count = 0;
const uint32_t vertexCount = inputMesh.vertexCount();
const uint32_t edgeCount = inputMesh.edgeCount();
for (uint32_t v = 0; v < vertexCount; v++) {
if (!inputMesh.isBoundaryVertex(v))
continue;
// Find edges that this vertex overlaps with.
const Vector3 &pos = inputMesh.position(v);
for (uint32_t e = 0; e < edgeCount; e++) {
if (!inputMesh.isBoundaryEdge(e))
continue;
const Vector3 &edgePos1 = inputMesh.position(inputMesh.vertexAt(meshEdgeIndex0(e)));
const Vector3 &edgePos2 = inputMesh.position(inputMesh.vertexAt(meshEdgeIndex1(e)));
float t;
if (lineIntersectsPoint(pos, edgePos1, edgePos2, &t, inputMesh.epsilon()))
count++;
}
}
return count;
}
#endif
// References invalid faces and vertices in a mesh.
struct InvalidMeshGeometry {
// If meshFaceGroups is not null, invalid faces have the face group MeshFaceGroups::kInvalid.
// If meshFaceGroups is null, invalid faces are Mesh::isFaceIgnored.
void extract(const Mesh *mesh, const MeshFaceGroups *meshFaceGroups) {
// Copy invalid faces.
m_faces.clear();
const uint32_t meshFaceCount = mesh->faceCount();
for (uint32_t f = 0; f < meshFaceCount; f++) {
if ((meshFaceGroups && meshFaceGroups->groupAt(f) == MeshFaceGroups::kInvalid) || (!meshFaceGroups && mesh->isFaceIgnored(f)))
m_faces.push_back(f);
}
// Create *unique* list of vertices of invalid faces.
const uint32_t faceCount = m_faces.size();
m_indices.resize(faceCount * 3);
const uint32_t approxVertexCount = min(faceCount * 3, mesh->vertexCount());
m_vertexToSourceVertexMap.clear();
m_vertexToSourceVertexMap.reserve(approxVertexCount);
HashMap<uint32_t, PassthroughHash<uint32_t>> sourceVertexToVertexMap(MemTag::Mesh, approxVertexCount);
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t face = m_faces[f];
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = mesh->vertexAt(face * 3 + i);
uint32_t newVertex = sourceVertexToVertexMap.get(vertex);
if (newVertex == UINT32_MAX) {
newVertex = sourceVertexToVertexMap.add(vertex);
m_vertexToSourceVertexMap.push_back(vertex);
}
m_indices[f * 3 + i] = newVertex;
}
}
}
ConstArrayView<uint32_t> faces() const { return m_faces; }
ConstArrayView<uint32_t> indices() const { return m_indices; }
ConstArrayView<uint32_t> vertices() const { return m_vertexToSourceVertexMap; }
private:
Array<uint32_t> m_faces, m_indices;
Array<uint32_t> m_vertexToSourceVertexMap; // Map face vertices to vertices of the source mesh.
};
struct Progress {
Progress(ProgressCategory category, ProgressFunc func, void *userData, uint32_t maxValue) :
cancel(false), m_category(category), m_func(func), m_userData(userData), m_value(0), m_maxValue(maxValue), m_percent(0) {
if (m_func) {
if (!m_func(category, 0, userData))
cancel = true;
}
}
~Progress() {
if (m_func) {
if (!m_func(m_category, 100, m_userData))
cancel = true;
}
}
void increment(uint32_t value) {
m_value += value;
update();
}
void setMaxValue(uint32_t maxValue) {
m_maxValue = maxValue;
update();
}
std::atomic<bool> cancel;
private:
void update() {
if (!m_func)
return;
const uint32_t newPercent = uint32_t(ceilf(m_value.load() / (float)m_maxValue.load() * 100.0f));
if (newPercent != m_percent) {
// Atomic max.
uint32_t oldPercent = m_percent;
while (oldPercent < newPercent && !m_percent.compare_exchange_weak(oldPercent, newPercent)) {
}
if (!m_func(m_category, m_percent, m_userData))
cancel = true;
}
}
ProgressCategory m_category;
ProgressFunc m_func;
void *m_userData;
std::atomic<uint32_t> m_value, m_maxValue, m_percent;
};
struct Spinlock {
void lock() {
while (m_lock.test_and_set(std::memory_order_acquire)) {
}
}
void unlock() { m_lock.clear(std::memory_order_release); }
private:
std::atomic_flag m_lock = ATOMIC_FLAG_INIT;
};
struct TaskGroupHandle {
uint32_t value = UINT32_MAX;
};
struct Task {
void (*func)(void *groupUserData, void *taskUserData);
void *userData; // Passed to func as taskUserData.
};
class TaskScheduler {
public:
~TaskScheduler() {
for (uint32_t i = 0; i < m_groups.size(); i++)
destroyGroup({ i });
}
uint32_t threadCount() const {
return 1;
}
TaskGroupHandle createTaskGroup(void *userData = nullptr, uint32_t reserveSize = 0) {
TaskGroup *group = XA_NEW(MemTag::Default, TaskGroup);
group->queue.reserve(reserveSize);
group->userData = userData;
m_groups.push_back(group);
TaskGroupHandle handle;
handle.value = m_groups.size() - 1;
return handle;
}
void run(TaskGroupHandle handle, Task task) {
m_groups[handle.value]->queue.push_back(task);
}
void wait(TaskGroupHandle *handle) {
if (handle->value == UINT32_MAX) {
XA_DEBUG_ASSERT(false);
return;
}
TaskGroup *group = m_groups[handle->value];
for (uint32_t i = 0; i < group->queue.size(); i++)
group->queue[i].func(group->userData, group->queue[i].userData);
group->queue.clear();
destroyGroup(*handle);
handle->value = UINT32_MAX;
}
static uint32_t currentThreadIndex() { return 0; }
private:
void destroyGroup(TaskGroupHandle handle) {
TaskGroup *group = m_groups[handle.value];
if (group) {
group->~TaskGroup();
XA_FREE(group);
m_groups[handle.value] = nullptr;
}
}
struct TaskGroup {
Array<Task> queue;
void *userData;
};
Array<TaskGroup *> m_groups;
};
template <typename T>
class ThreadLocal {
public:
ThreadLocal() {
const uint32_t n = 1;
m_array = XA_ALLOC_ARRAY(MemTag::Default, T, n);
for (uint32_t i = 0; i < n; i++)
new (&m_array[i]) T;
}
~ThreadLocal() {
const uint32_t n = 1;
for (uint32_t i = 0; i < n; i++)
m_array[i].~T();
XA_FREE(m_array);
}
T &get() const {
return m_array[TaskScheduler::currentThreadIndex()];
}
private:
T *m_array;
};
// Implemented as a struct so the temporary arrays can be reused.
struct Triangulator {
// This is doing a simple ear-clipping algorithm that skips invalid triangles. Ideally, we should
// also sort the ears by angle, start with the ones that have the smallest angle and proceed in order.
void triangulatePolygon(ConstArrayView<Vector3> vertices, ConstArrayView<uint32_t> inputIndices, Array<uint32_t> &outputIndices) {
m_polygonVertices.clear();
m_polygonVertices.reserve(inputIndices.length);
outputIndices.clear();
if (inputIndices.length == 3) {
// Simple case for triangles.
outputIndices.push_back(inputIndices[0]);
outputIndices.push_back(inputIndices[1]);
outputIndices.push_back(inputIndices[2]);
} else {
// Build 2D polygon projecting vertices onto normal plane.
// Faces are not necesarily planar, this is for example the case, when the face comes from filling a hole. In such cases
// it's much better to use the best fit plane.
Basis basis;
basis.normal = normalize(cross(vertices[inputIndices[1]] - vertices[inputIndices[0]], vertices[inputIndices[2]] - vertices[inputIndices[1]]));
basis.tangent = basis.computeTangent(basis.normal);
basis.bitangent = basis.computeBitangent(basis.normal, basis.tangent);
const uint32_t edgeCount = inputIndices.length;
m_polygonPoints.clear();
m_polygonPoints.reserve(edgeCount);
m_polygonAngles.clear();
m_polygonAngles.reserve(edgeCount);
for (uint32_t i = 0; i < inputIndices.length; i++) {
m_polygonVertices.push_back(inputIndices[i]);
const Vector3 &pos = vertices[inputIndices[i]];
m_polygonPoints.push_back(Vector2(dot(basis.tangent, pos), dot(basis.bitangent, pos)));
}
m_polygonAngles.resize(edgeCount);
while (m_polygonVertices.size() > 2) {
const uint32_t size = m_polygonVertices.size();
// Update polygon angles. @@ Update only those that have changed.
float minAngle = kPi2;
uint32_t bestEar = 0; // Use first one if none of them is valid.
bool bestIsValid = false;
for (uint32_t i = 0; i < size; i++) {
uint32_t i0 = i;
uint32_t i1 = (i + 1) % size; // Use Sean's polygon interation trick.
uint32_t i2 = (i + 2) % size;
Vector2 p0 = m_polygonPoints[i0];
Vector2 p1 = m_polygonPoints[i1];
Vector2 p2 = m_polygonPoints[i2];
float d = clamp(dot(p0 - p1, p2 - p1) / (length(p0 - p1) * length(p2 - p1)), -1.0f, 1.0f);
float angle = acosf(d);
float area = triangleArea(p0, p1, p2);
if (area < 0.0f)
angle = kPi2 - angle;
m_polygonAngles[i1] = angle;
if (angle < minAngle || !bestIsValid) {
// Make sure this is a valid ear, if not, skip this point.
bool valid = true;
for (uint32_t j = 0; j < size; j++) {
if (j == i0 || j == i1 || j == i2)
continue;
Vector2 p = m_polygonPoints[j];
if (pointInTriangle(p, p0, p1, p2)) {
valid = false;
break;
}
}
if (valid || !bestIsValid) {
minAngle = angle;
bestEar = i1;
bestIsValid = valid;
}
}
}
// Clip best ear:
const uint32_t i0 = (bestEar + size - 1) % size;
const uint32_t i1 = (bestEar + 0) % size;
const uint32_t i2 = (bestEar + 1) % size;
outputIndices.push_back(m_polygonVertices[i0]);
outputIndices.push_back(m_polygonVertices[i1]);
outputIndices.push_back(m_polygonVertices[i2]);
m_polygonVertices.removeAt(i1);
m_polygonPoints.removeAt(i1);
m_polygonAngles.removeAt(i1);
}
}
}
private:
static bool pointInTriangle(const Vector2 &p, const Vector2 &a, const Vector2 &b, const Vector2 &c) {
return triangleArea(a, b, p) >= kAreaEpsilon && triangleArea(b, c, p) >= kAreaEpsilon && triangleArea(c, a, p) >= kAreaEpsilon;
}
Array<int> m_polygonVertices;
Array<float> m_polygonAngles;
Array<Vector2> m_polygonPoints;
};
class UniformGrid2 {
public:
// indices are optional.
void reset(ConstArrayView<Vector2> positions, ConstArrayView<uint32_t> indices = ConstArrayView<uint32_t>(), uint32_t reserveEdgeCount = 0) {
m_edges.clear();
if (reserveEdgeCount > 0)
m_edges.reserve(reserveEdgeCount);
m_positions = positions;
m_indices = indices;
m_cellDataOffsets.clear();
}
void append(uint32_t edge) {
XA_DEBUG_ASSERT(m_cellDataOffsets.isEmpty());
m_edges.push_back(edge);
}
bool intersect(Vector2 v1, Vector2 v2, float epsilon) {
const uint32_t edgeCount = m_edges.size();
bool bruteForce = edgeCount <= 20;
if (!bruteForce && m_cellDataOffsets.isEmpty())
bruteForce = !createGrid();
if (bruteForce) {
for (uint32_t j = 0; j < edgeCount; j++) {
const uint32_t edge = m_edges[j];
if (linesIntersect(v1, v2, edgePosition0(edge), edgePosition1(edge), epsilon))
return true;
}
} else {
computePotentialEdges(v1, v2);
uint32_t prevEdge = UINT32_MAX;
for (uint32_t j = 0; j < m_potentialEdges.size(); j++) {
const uint32_t edge = m_potentialEdges[j];
if (edge == prevEdge)
continue;
if (linesIntersect(v1, v2, edgePosition0(edge), edgePosition1(edge), epsilon))
return true;
prevEdge = edge;
}
}
return false;
}
// If edges is empty, checks for intersection with all edges in the grid.
bool intersect(float epsilon, ConstArrayView<uint32_t> edges = ConstArrayView<uint32_t>(), ConstArrayView<uint32_t> ignoreEdges = ConstArrayView<uint32_t>()) {
bool bruteForce = m_edges.size() <= 20;
if (!bruteForce && m_cellDataOffsets.isEmpty())
bruteForce = !createGrid();
const uint32_t *edges1, *edges2 = nullptr;
uint32_t edges1Count, edges2Count = 0;
if (edges.length == 0) {
edges1 = m_edges.data();
edges1Count = m_edges.size();
} else {
edges1 = edges.data;
edges1Count = edges.length;
}
if (bruteForce) {
edges2 = m_edges.data();
edges2Count = m_edges.size();
}
for (uint32_t i = 0; i < edges1Count; i++) {
const uint32_t edge1 = edges1[i];
const uint32_t edge1Vertex[2] = { vertexAt(meshEdgeIndex0(edge1)), vertexAt(meshEdgeIndex1(edge1)) };
const Vector2 &edge1Position1 = m_positions[edge1Vertex[0]];
const Vector2 &edge1Position2 = m_positions[edge1Vertex[1]];
const Extents2 edge1Extents(edge1Position1, edge1Position2);
uint32_t j = 0;
if (bruteForce) {
// If checking against self, test each edge pair only once.
if (edges.length == 0) {
j = i + 1;
if (j == edges1Count)
break;
}
} else {
computePotentialEdges(edgePosition0(edge1), edgePosition1(edge1));
edges2 = m_potentialEdges.data();
edges2Count = m_potentialEdges.size();
}
uint32_t prevEdge = UINT32_MAX; // Handle potential edges duplicates.
for (; j < edges2Count; j++) {
const uint32_t edge2 = edges2[j];
if (edge1 == edge2)
continue;
if (edge2 == prevEdge)
continue;
prevEdge = edge2;
// Check if edge2 is ignored.
bool ignore = false;
for (uint32_t k = 0; k < ignoreEdges.length; k++) {
if (edge2 == ignoreEdges[k]) {
ignore = true;
break;
}
}
if (ignore)
continue;
const uint32_t edge2Vertex[2] = { vertexAt(meshEdgeIndex0(edge2)), vertexAt(meshEdgeIndex1(edge2)) };
// Ignore connected edges, since they can't intersect (only overlap), and may be detected as false positives.
if (edge1Vertex[0] == edge2Vertex[0] || edge1Vertex[0] == edge2Vertex[1] || edge1Vertex[1] == edge2Vertex[0] || edge1Vertex[1] == edge2Vertex[1])
continue;
const Vector2 &edge2Position1 = m_positions[edge2Vertex[0]];
const Vector2 &edge2Position2 = m_positions[edge2Vertex[1]];
if (!Extents2::intersect(edge1Extents, Extents2(edge2Position1, edge2Position2)))
continue;
if (linesIntersect(edge1Position1, edge1Position2, edge2Position1, edge2Position2, epsilon))
return true;
}
}
return false;
}
#if XA_DEBUG_EXPORT_BOUNDARY_GRID
void debugExport(const char *filename) {
Array<uint8_t> image;
image.resize(m_gridWidth * m_gridHeight * 3);
for (uint32_t y = 0; y < m_gridHeight; y++) {
for (uint32_t x = 0; x < m_gridWidth; x++) {
uint8_t *bgr = &image[(x + y * m_gridWidth) * 3];
bgr[0] = bgr[1] = bgr[2] = 32;
uint32_t offset = m_cellDataOffsets[x + y * m_gridWidth];
while (offset != UINT32_MAX) {
const uint32_t edge2 = m_cellData[offset];
srand(edge2);
for (uint32_t i = 0; i < 3; i++)
bgr[i] = uint8_t(bgr[i] * 0.5f + (rand() % 255) * 0.5f);
offset = m_cellData[offset + 1];
}
}
}
WriteTga(filename, image.data(), m_gridWidth, m_gridHeight);
}
#endif
private:
bool createGrid() {
// Compute edge extents. Min will be the grid origin.
const uint32_t edgeCount = m_edges.size();
Extents2 edgeExtents;
edgeExtents.reset();
for (uint32_t i = 0; i < edgeCount; i++) {
const uint32_t edge = m_edges[i];
edgeExtents.add(edgePosition0(edge));
edgeExtents.add(edgePosition1(edge));
}
m_gridOrigin = edgeExtents.min;
// Size grid to approximately one edge per cell in the largest dimension.
const Vector2 extentsSize(edgeExtents.max - edgeExtents.min);
m_cellSize = max(extentsSize.x, extentsSize.y) / (float)clamp(edgeCount, 32u, 512u);
if (m_cellSize <= 0.0f)
return false;
m_gridWidth = uint32_t(ceilf(extentsSize.x / m_cellSize));
m_gridHeight = uint32_t(ceilf(extentsSize.y / m_cellSize));
if (m_gridWidth <= 1 || m_gridHeight <= 1)
return false;
// Insert edges into cells.
m_cellDataOffsets.resize(m_gridWidth * m_gridHeight);
for (uint32_t i = 0; i < m_cellDataOffsets.size(); i++)
m_cellDataOffsets[i] = UINT32_MAX;
m_cellData.clear();
m_cellData.reserve(edgeCount * 2);
for (uint32_t i = 0; i < edgeCount; i++) {
const uint32_t edge = m_edges[i];
traverse(edgePosition0(edge), edgePosition1(edge));
XA_DEBUG_ASSERT(!m_traversedCellOffsets.isEmpty());
for (uint32_t j = 0; j < m_traversedCellOffsets.size(); j++) {
const uint32_t cell = m_traversedCellOffsets[j];
uint32_t offset = m_cellDataOffsets[cell];
if (offset == UINT32_MAX)
m_cellDataOffsets[cell] = m_cellData.size();
else {
for (;;) {
uint32_t &nextOffset = m_cellData[offset + 1];
if (nextOffset == UINT32_MAX) {
nextOffset = m_cellData.size();
break;
}
offset = nextOffset;
}
}
m_cellData.push_back(edge);
m_cellData.push_back(UINT32_MAX);
}
}
return true;
}
void computePotentialEdges(Vector2 p1, Vector2 p2) {
m_potentialEdges.clear();
traverse(p1, p2);
for (uint32_t j = 0; j < m_traversedCellOffsets.size(); j++) {
const uint32_t cell = m_traversedCellOffsets[j];
uint32_t offset = m_cellDataOffsets[cell];
while (offset != UINT32_MAX) {
const uint32_t edge2 = m_cellData[offset];
m_potentialEdges.push_back(edge2);
offset = m_cellData[offset + 1];
}
}
if (m_potentialEdges.isEmpty())
return;
insertionSort(m_potentialEdges.data(), m_potentialEdges.size());
}
// "A Fast Voxel Traversal Algorithm for Ray Tracing"
void traverse(Vector2 p1, Vector2 p2) {
const Vector2 dir = p2 - p1;
const Vector2 normal = normalizeSafe(dir, Vector2(0.0f));
const int stepX = dir.x >= 0 ? 1 : -1;
const int stepY = dir.y >= 0 ? 1 : -1;
const uint32_t firstCell[2] = { cellX(p1.x), cellY(p1.y) };
const uint32_t lastCell[2] = { cellX(p2.x), cellY(p2.y) };
float distToNextCellX;
if (stepX == 1)
distToNextCellX = (firstCell[0] + 1) * m_cellSize - (p1.x - m_gridOrigin.x);
else
distToNextCellX = (p1.x - m_gridOrigin.x) - firstCell[0] * m_cellSize;
float distToNextCellY;
if (stepY == 1)
distToNextCellY = (firstCell[1] + 1) * m_cellSize - (p1.y - m_gridOrigin.y);
else
distToNextCellY = (p1.y - m_gridOrigin.y) - firstCell[1] * m_cellSize;
float tMaxX, tMaxY, tDeltaX, tDeltaY;
if (normal.x > kEpsilon || normal.x < -kEpsilon) {
tMaxX = (distToNextCellX * stepX) / normal.x;
tDeltaX = (m_cellSize * stepX) / normal.x;
} else
tMaxX = tDeltaX = FLT_MAX;
if (normal.y > kEpsilon || normal.y < -kEpsilon) {
tMaxY = (distToNextCellY * stepY) / normal.y;
tDeltaY = (m_cellSize * stepY) / normal.y;
} else
tMaxY = tDeltaY = FLT_MAX;
m_traversedCellOffsets.clear();
m_traversedCellOffsets.push_back(firstCell[0] + firstCell[1] * m_gridWidth);
uint32_t currentCell[2] = { firstCell[0], firstCell[1] };
while (!(currentCell[0] == lastCell[0] && currentCell[1] == lastCell[1])) {
if (tMaxX < tMaxY) {
tMaxX += tDeltaX;
currentCell[0] += stepX;
} else {
tMaxY += tDeltaY;
currentCell[1] += stepY;
}
if (currentCell[0] >= m_gridWidth || currentCell[1] >= m_gridHeight)
break;
if (stepX == -1 && currentCell[0] < lastCell[0])
break;
if (stepX == 1 && currentCell[0] > lastCell[0])
break;
if (stepY == -1 && currentCell[1] < lastCell[1])
break;
if (stepY == 1 && currentCell[1] > lastCell[1])
break;
m_traversedCellOffsets.push_back(currentCell[0] + currentCell[1] * m_gridWidth);
}
}
uint32_t cellX(float x) const {
return min((uint32_t)max(0.0f, (x - m_gridOrigin.x) / m_cellSize), m_gridWidth - 1u);
}
uint32_t cellY(float y) const {
return min((uint32_t)max(0.0f, (y - m_gridOrigin.y) / m_cellSize), m_gridHeight - 1u);
}
Vector2 edgePosition0(uint32_t edge) const {
return m_positions[vertexAt(meshEdgeIndex0(edge))];
}
Vector2 edgePosition1(uint32_t edge) const {
return m_positions[vertexAt(meshEdgeIndex1(edge))];
}
uint32_t vertexAt(uint32_t index) const {
return m_indices.length > 0 ? m_indices[index] : index;
}
Array<uint32_t> m_edges;
ConstArrayView<Vector2> m_positions;
ConstArrayView<uint32_t> m_indices; // Optional. Empty if unused.
float m_cellSize;
Vector2 m_gridOrigin;
uint32_t m_gridWidth, m_gridHeight; // in cells
Array<uint32_t> m_cellDataOffsets;
Array<uint32_t> m_cellData;
Array<uint32_t> m_potentialEdges;
Array<uint32_t> m_traversedCellOffsets;
};
struct UvMeshChart {
Array<uint32_t> faces;
Array<uint32_t> indices;
uint32_t material;
};
struct UvMesh {
UvMeshDecl decl;
BitArray faceIgnore;
Array<uint32_t> faceMaterials;
Array<uint32_t> indices;
Array<Vector2> texcoords; // Copied from input and never modified, UvMeshInstance::texcoords are. Used to restore UvMeshInstance::texcoords so packing can be run multiple times.
Array<UvMeshChart *> charts;
Array<uint32_t> vertexToChartMap;
};
struct UvMeshInstance {
UvMesh *mesh;
Array<Vector2> texcoords;
};
/*
* Copyright (c) 2004-2010, Bruno Levy
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are met:
*
* * Redistributions of source code must retain the above copyright notice,
* this list of conditions and the following disclaimer.
* * Redistributions in binary form must reproduce the above copyright notice,
* this list of conditions and the following disclaimer in the documentation
* and/or other materials provided with the distribution.
* * Neither the name of the ALICE Project-Team nor the names of its
* contributors may be used to endorse or promote products derived from this
* software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*
* If you modify this software, you should include a notice giving the
* name of the person performing the modification, the date of modification,
* and the reason for such modification.
*
* Contact: Bruno Levy
*
* levy@loria.fr
*
* ALICE Project
* LORIA, INRIA Lorraine,
* Campus Scientifique, BP 239
* 54506 VANDOEUVRE LES NANCY CEDEX
* FRANCE
*/
namespace opennl {
#define NL_NEW(T) XA_ALLOC(MemTag::OpenNL, T)
#define NL_NEW_ARRAY(T, NB) XA_ALLOC_ARRAY(MemTag::OpenNL, T, NB)
#define NL_RENEW_ARRAY(T, x, NB) XA_REALLOC(MemTag::OpenNL, x, T, NB)
#define NL_DELETE(x) \
XA_FREE(x); \
x = nullptr
#define NL_DELETE_ARRAY(x) \
XA_FREE(x); \
x = nullptr
#define NL_CLEAR(x, T) memset(x, 0, sizeof(T));
#define NL_CLEAR_ARRAY(T, x, NB) memset(x, 0, (size_t)(NB) * sizeof(T))
#define NL_NEW_VECTOR(dim) XA_ALLOC_ARRAY(MemTag::OpenNL, double, dim)
#define NL_DELETE_VECTOR(ptr) XA_FREE(ptr)
struct NLMatrixStruct;
typedef NLMatrixStruct *NLMatrix;
typedef void (*NLDestroyMatrixFunc)(NLMatrix M);
typedef void (*NLMultMatrixVectorFunc)(NLMatrix M, const double *x, double *y);
#define NL_MATRIX_SPARSE_DYNAMIC 0x1001
#define NL_MATRIX_CRS 0x1002
#define NL_MATRIX_OTHER 0x1006
struct NLMatrixStruct {
uint32_t m;
uint32_t n;
uint32_t type;
NLDestroyMatrixFunc destroy_func;
NLMultMatrixVectorFunc mult_func;
};
/* Dynamic arrays for sparse row/columns */
struct NLCoeff {
uint32_t index;
double value;
};
struct NLRowColumn {
uint32_t size;
uint32_t capacity;
NLCoeff *coeff;
};
/* Compressed Row Storage */
struct NLCRSMatrix {
uint32_t m;
uint32_t n;
uint32_t type;
NLDestroyMatrixFunc destroy_func;
NLMultMatrixVectorFunc mult_func;
double *val;
uint32_t *rowptr;
uint32_t *colind;
uint32_t nslices;
uint32_t *sliceptr;
};
/* SparseMatrix data structure */
struct NLSparseMatrix {
uint32_t m;
uint32_t n;
uint32_t type;
NLDestroyMatrixFunc destroy_func;
NLMultMatrixVectorFunc mult_func;
uint32_t diag_size;
uint32_t diag_capacity;
NLRowColumn *row;
NLRowColumn *column;
double *diag;
uint32_t row_capacity;
uint32_t column_capacity;
};
/* NLContext data structure */
struct NLBufferBinding {
void *base_address;
uint32_t stride;
};
#define NL_BUFFER_ITEM(B, i) *(double *)((void *)((char *)((B).base_address) + ((i) * (B).stride)))
struct NLContext {
NLBufferBinding *variable_buffer;
double *variable_value;
bool *variable_is_locked;
uint32_t *variable_index;
uint32_t n;
NLMatrix M;
NLMatrix P;
NLMatrix B;
NLRowColumn af;
NLRowColumn al;
double *x;
double *b;
uint32_t nb_variables;
uint32_t nb_systems;
uint32_t current_row;
uint32_t max_iterations;
bool max_iterations_defined;
double threshold;
double omega;
uint32_t used_iterations;
double error;
};
static void nlDeleteMatrix(NLMatrix M) {
if (!M)
return;
M->destroy_func(M);
NL_DELETE(M);
}
static void nlMultMatrixVector(NLMatrix M, const double *x, double *y) {
M->mult_func(M, x, y);
}
static void nlRowColumnConstruct(NLRowColumn *c) {
c->size = 0;
c->capacity = 0;
c->coeff = nullptr;
}
static void nlRowColumnDestroy(NLRowColumn *c) {
NL_DELETE_ARRAY(c->coeff);
c->size = 0;
c->capacity = 0;
}
static void nlRowColumnGrow(NLRowColumn *c) {
if (c->capacity != 0) {
c->capacity = 2 * c->capacity;
c->coeff = NL_RENEW_ARRAY(NLCoeff, c->coeff, c->capacity);
} else {
c->capacity = 4;
c->coeff = NL_NEW_ARRAY(NLCoeff, c->capacity);
NL_CLEAR_ARRAY(NLCoeff, c->coeff, c->capacity);
}
}
static void nlRowColumnAdd(NLRowColumn *c, uint32_t index, double value) {
for (uint32_t i = 0; i < c->size; i++) {
if (c->coeff[i].index == index) {
c->coeff[i].value += value;
return;
}
}
if (c->size == c->capacity)
nlRowColumnGrow(c);
c->coeff[c->size].index = index;
c->coeff[c->size].value = value;
c->size++;
}
/* Does not check whether the index already exists */
static void nlRowColumnAppend(NLRowColumn *c, uint32_t index, double value) {
if (c->size == c->capacity)
nlRowColumnGrow(c);
c->coeff[c->size].index = index;
c->coeff[c->size].value = value;
c->size++;
}
static void nlRowColumnZero(NLRowColumn *c) {
c->size = 0;
}
static void nlRowColumnClear(NLRowColumn *c) {
c->size = 0;
c->capacity = 0;
NL_DELETE_ARRAY(c->coeff);
}
static int nlCoeffCompare(const void *p1, const void *p2) {
return (((NLCoeff *)(p2))->index < ((NLCoeff *)(p1))->index);
}
static void nlRowColumnSort(NLRowColumn *c) {
qsort(c->coeff, c->size, sizeof(NLCoeff), nlCoeffCompare);
}
/* CRSMatrix data structure */
static void nlCRSMatrixDestroy(NLCRSMatrix *M) {
NL_DELETE_ARRAY(M->val);
NL_DELETE_ARRAY(M->rowptr);
NL_DELETE_ARRAY(M->colind);
NL_DELETE_ARRAY(M->sliceptr);
M->m = 0;
M->n = 0;
M->nslices = 0;
}
static void nlCRSMatrixMultSlice(NLCRSMatrix *M, const double *x, double *y, uint32_t Ibegin, uint32_t Iend) {
for (uint32_t i = Ibegin; i < Iend; ++i) {
double sum = 0.0;
for (uint32_t j = M->rowptr[i]; j < M->rowptr[i + 1]; ++j)
sum += M->val[j] * x[M->colind[j]];
y[i] = sum;
}
}
static void nlCRSMatrixMult(NLCRSMatrix *M, const double *x, double *y) {
int nslices = (int)(M->nslices);
for (int slice = 0; slice < nslices; ++slice)
nlCRSMatrixMultSlice(M, x, y, M->sliceptr[slice], M->sliceptr[slice + 1]);
}
static void nlCRSMatrixConstruct(NLCRSMatrix *M, uint32_t m, uint32_t n, uint32_t nnz, uint32_t nslices) {
M->m = m;
M->n = n;
M->type = NL_MATRIX_CRS;
M->destroy_func = (NLDestroyMatrixFunc)nlCRSMatrixDestroy;
M->mult_func = (NLMultMatrixVectorFunc)nlCRSMatrixMult;
M->nslices = nslices;
M->val = NL_NEW_ARRAY(double, nnz);
NL_CLEAR_ARRAY(double, M->val, nnz);
M->rowptr = NL_NEW_ARRAY(uint32_t, m + 1);
NL_CLEAR_ARRAY(uint32_t, M->rowptr, m + 1);
M->colind = NL_NEW_ARRAY(uint32_t, nnz);
NL_CLEAR_ARRAY(uint32_t, M->colind, nnz);
M->sliceptr = NL_NEW_ARRAY(uint32_t, nslices + 1);
NL_CLEAR_ARRAY(uint32_t, M->sliceptr, nslices + 1);
}
/* SparseMatrix data structure */
static void nlSparseMatrixDestroyRowColumns(NLSparseMatrix *M) {
for (uint32_t i = 0; i < M->m; i++)
nlRowColumnDestroy(&(M->row[i]));
NL_DELETE_ARRAY(M->row);
}
static void nlSparseMatrixDestroy(NLSparseMatrix *M) {
XA_DEBUG_ASSERT(M->type == NL_MATRIX_SPARSE_DYNAMIC);
nlSparseMatrixDestroyRowColumns(M);
NL_DELETE_ARRAY(M->diag);
}
static void nlSparseMatrixAdd(NLSparseMatrix *M, uint32_t i, uint32_t j, double value) {
XA_DEBUG_ASSERT(i >= 0 && i <= M->m - 1);
XA_DEBUG_ASSERT(j >= 0 && j <= M->n - 1);
if (i == j)
M->diag[i] += value;
nlRowColumnAdd(&(M->row[i]), j, value);
}
/* Returns the number of non-zero coefficients */
static uint32_t nlSparseMatrixNNZ(NLSparseMatrix *M) {
uint32_t nnz = 0;
for (uint32_t i = 0; i < M->m; i++)
nnz += M->row[i].size;
return nnz;
}
static void nlSparseMatrixSort(NLSparseMatrix *M) {
for (uint32_t i = 0; i < M->m; i++)
nlRowColumnSort(&(M->row[i]));
}
/* SparseMatrix x Vector routines, internal helper routines */
static void nlSparseMatrix_mult_rows(NLSparseMatrix *A, const double *x, double *y) {
/*
* Note: OpenMP does not like unsigned ints
* (causes some floating point exceptions),
* therefore I use here signed ints for all
* indices.
*/
int m = (int)(A->m);
NLCoeff *c = nullptr;
NLRowColumn *Ri = nullptr;
for (int i = 0; i < m; i++) {
Ri = &(A->row[i]);
y[i] = 0;
for (int ij = 0; ij < (int)(Ri->size); ij++) {
c = &(Ri->coeff[ij]);
y[i] += c->value * x[c->index];
}
}
}
static void nlSparseMatrixMult(NLSparseMatrix *A, const double *x, double *y) {
XA_DEBUG_ASSERT(A->type == NL_MATRIX_SPARSE_DYNAMIC);
nlSparseMatrix_mult_rows(A, x, y);
}
static void nlSparseMatrixConstruct(NLSparseMatrix *M, uint32_t m, uint32_t n) {
M->m = m;
M->n = n;
M->type = NL_MATRIX_SPARSE_DYNAMIC;
M->destroy_func = (NLDestroyMatrixFunc)nlSparseMatrixDestroy;
M->mult_func = (NLMultMatrixVectorFunc)nlSparseMatrixMult;
M->row = NL_NEW_ARRAY(NLRowColumn, m);
NL_CLEAR_ARRAY(NLRowColumn, M->row, m);
M->row_capacity = m;
for (uint32_t i = 0; i < n; i++)
nlRowColumnConstruct(&(M->row[i]));
M->row_capacity = 0;
M->column = nullptr;
M->column_capacity = 0;
M->diag_size = min(m, n);
M->diag_capacity = M->diag_size;
M->diag = NL_NEW_ARRAY(double, M->diag_size);
NL_CLEAR_ARRAY(double, M->diag, M->diag_size);
}
static NLMatrix nlCRSMatrixNewFromSparseMatrix(NLSparseMatrix *M) {
uint32_t nnz = nlSparseMatrixNNZ(M);
uint32_t nslices = 8; /* TODO: get number of cores */
uint32_t slice, cur_bound, cur_NNZ, cur_row;
uint32_t k;
uint32_t slice_size = nnz / nslices;
NLCRSMatrix *CRS = NL_NEW(NLCRSMatrix);
NL_CLEAR(CRS, NLCRSMatrix);
nlCRSMatrixConstruct(CRS, M->m, M->n, nnz, nslices);
nlSparseMatrixSort(M);
/* Convert matrix to CRS format */
k = 0;
for (uint32_t i = 0; i < M->m; ++i) {
NLRowColumn *Ri = &(M->row[i]);
CRS->rowptr[i] = k;
for (uint32_t ij = 0; ij < Ri->size; ij++) {
NLCoeff *c = &(Ri->coeff[ij]);
CRS->val[k] = c->value;
CRS->colind[k] = c->index;
++k;
}
}
CRS->rowptr[M->m] = k;
/* Create "slices" to be used by parallel sparse matrix vector product */
if (CRS->sliceptr) {
cur_bound = slice_size;
cur_NNZ = 0;
cur_row = 0;
CRS->sliceptr[0] = 0;
for (slice = 1; slice < nslices; ++slice) {
while (cur_NNZ < cur_bound && cur_row < M->m) {
++cur_row;
cur_NNZ += CRS->rowptr[cur_row + 1] - CRS->rowptr[cur_row];
}
CRS->sliceptr[slice] = cur_row;
cur_bound += slice_size;
}
CRS->sliceptr[nslices] = M->m;
}
return (NLMatrix)CRS;
}
static void nlMatrixCompress(NLMatrix *M) {
NLMatrix CRS = nullptr;
if ((*M)->type != NL_MATRIX_SPARSE_DYNAMIC)
return;
CRS = nlCRSMatrixNewFromSparseMatrix((NLSparseMatrix *)*M);
nlDeleteMatrix(*M);
*M = CRS;
}
static NLContext *nlNewContext() {
NLContext *result = NL_NEW(NLContext);
NL_CLEAR(result, NLContext);
result->max_iterations = 100;
result->threshold = 1e-6;
result->omega = 1.5;
result->nb_systems = 1;
return result;
}
static void nlDeleteContext(NLContext *context) {
nlDeleteMatrix(context->M);
context->M = nullptr;
nlDeleteMatrix(context->P);
context->P = nullptr;
nlDeleteMatrix(context->B);
context->B = nullptr;
nlRowColumnDestroy(&context->af);
nlRowColumnDestroy(&context->al);
NL_DELETE_ARRAY(context->variable_value);
NL_DELETE_ARRAY(context->variable_buffer);
NL_DELETE_ARRAY(context->variable_is_locked);
NL_DELETE_ARRAY(context->variable_index);
NL_DELETE_ARRAY(context->x);
NL_DELETE_ARRAY(context->b);
NL_DELETE(context);
}
static double ddot(int n, const double *x, const double *y) {
double sum = 0.0;
for (int i = 0; i < n; i++)
sum += x[i] * y[i];
return sum;
}
static void daxpy(int n, double a, const double *x, double *y) {
for (int i = 0; i < n; i++)
y[i] = a * x[i] + y[i];
}
static void dscal(int n, double a, double *x) {
for (int i = 0; i < n; i++)
x[i] *= a;
}
/*
* The implementation of the solvers is inspired by
* the lsolver library, by Christian Badura, available from:
* http://www.mathematik.uni-freiburg.de
* /IAM/Research/projectskr/lin_solver/
*
* About the Conjugate Gradient, details can be found in:
* Ashby, Manteuffel, Saylor
* A taxononmy for conjugate gradient methods
* SIAM J Numer Anal 27, 1542-1568 (1990)
*
* This version is completely abstract, the same code can be used for
* CPU/GPU, dense matrix / sparse matrix etc...
* Abstraction is realized through:
* - Abstract matrix interface (NLMatrix), that can implement different
* versions of matrix x vector product (CPU/GPU, sparse/dense ...)
*/
static uint32_t nlSolveSystem_PRE_CG(NLMatrix M, NLMatrix P, double *b, double *x, double eps, uint32_t max_iter, double *sq_bnorm, double *sq_rnorm) {
int N = (int)M->n;
double *r = NL_NEW_VECTOR(N);
double *d = NL_NEW_VECTOR(N);
double *h = NL_NEW_VECTOR(N);
double *Ad = h;
uint32_t its = 0;
double rh, alpha, beta;
double b_square = ddot(N, b, b);
double err = eps * eps * b_square;
double curr_err;
nlMultMatrixVector(M, x, r);
daxpy(N, -1., b, r);
nlMultMatrixVector(P, r, d);
memcpy(h, d, N * sizeof(double));
rh = ddot(N, r, h);
curr_err = ddot(N, r, r);
while (curr_err > err && its < max_iter) {
nlMultMatrixVector(M, d, Ad);
alpha = rh / ddot(N, d, Ad);
daxpy(N, -alpha, d, x);
daxpy(N, -alpha, Ad, r);
nlMultMatrixVector(P, r, h);
beta = 1. / rh;
rh = ddot(N, r, h);
beta *= rh;
dscal(N, beta, d);
daxpy(N, 1., h, d);
++its;
curr_err = ddot(N, r, r);
}
NL_DELETE_VECTOR(r);
NL_DELETE_VECTOR(d);
NL_DELETE_VECTOR(h);
*sq_bnorm = b_square;
*sq_rnorm = curr_err;
return its;
}
static uint32_t nlSolveSystemIterative(NLContext *context, NLMatrix M, NLMatrix P, double *b_in, double *x_in, double eps, uint32_t max_iter) {
uint32_t result = 0;
double rnorm = 0.0;
double bnorm = 0.0;
double *b = b_in;
double *x = x_in;
XA_DEBUG_ASSERT(M->m == M->n);
double sq_bnorm, sq_rnorm;
result = nlSolveSystem_PRE_CG(M, P, b, x, eps, max_iter, &sq_bnorm, &sq_rnorm);
/* Get residual norm and rhs norm */
bnorm = sqrt(sq_bnorm);
rnorm = sqrt(sq_rnorm);
if (bnorm == 0.0)
context->error = rnorm;
else
context->error = rnorm / bnorm;
context->used_iterations = result;
return result;
}
static bool nlSolveIterative(NLContext *context) {
double *b = context->b;
double *x = context->x;
uint32_t n = context->n;
NLMatrix M = context->M;
NLMatrix P = context->P;
for (uint32_t k = 0; k < context->nb_systems; ++k) {
nlSolveSystemIterative(context, M, P, b, x, context->threshold, context->max_iterations);
b += n;
x += n;
}
return true;
}
struct NLJacobiPreconditioner {
uint32_t m;
uint32_t n;
uint32_t type;
NLDestroyMatrixFunc destroy_func;
NLMultMatrixVectorFunc mult_func;
double *diag_inv;
};
static void nlJacobiPreconditionerDestroy(NLJacobiPreconditioner *M) {
NL_DELETE_ARRAY(M->diag_inv);
}
static void nlJacobiPreconditionerMult(NLJacobiPreconditioner *M, const double *x, double *y) {
for (uint32_t i = 0; i < M->n; ++i)
y[i] = x[i] * M->diag_inv[i];
}
static NLMatrix nlNewJacobiPreconditioner(NLMatrix M_in) {
NLSparseMatrix *M = nullptr;
NLJacobiPreconditioner *result = nullptr;
XA_DEBUG_ASSERT(M_in->type == NL_MATRIX_SPARSE_DYNAMIC);
XA_DEBUG_ASSERT(M_in->m == M_in->n);
M = (NLSparseMatrix *)M_in;
result = NL_NEW(NLJacobiPreconditioner);
NL_CLEAR(result, NLJacobiPreconditioner);
result->m = M->m;
result->n = M->n;
result->type = NL_MATRIX_OTHER;
result->destroy_func = (NLDestroyMatrixFunc)nlJacobiPreconditionerDestroy;
result->mult_func = (NLMultMatrixVectorFunc)nlJacobiPreconditionerMult;
result->diag_inv = NL_NEW_ARRAY(double, M->n);
NL_CLEAR_ARRAY(double, result->diag_inv, M->n);
for (uint32_t i = 0; i < M->n; ++i)
result->diag_inv[i] = (M->diag[i] == 0.0) ? 1.0 : 1.0 / M->diag[i];
return (NLMatrix)result;
}
#define NL_NB_VARIABLES 0x101
#define NL_MAX_ITERATIONS 0x103
static void nlSolverParameteri(NLContext *context, uint32_t pname, int param) {
if (pname == NL_NB_VARIABLES) {
XA_DEBUG_ASSERT(param > 0);
context->nb_variables = (uint32_t)param;
} else if (pname == NL_MAX_ITERATIONS) {
XA_DEBUG_ASSERT(param > 0);
context->max_iterations = (uint32_t)param;
context->max_iterations_defined = true;
}
}
static void nlSetVariable(NLContext *context, uint32_t index, double value) {
XA_DEBUG_ASSERT(index >= 0 && index <= context->nb_variables - 1);
NL_BUFFER_ITEM(context->variable_buffer[0], index) = value;
}
static double nlGetVariable(NLContext *context, uint32_t index) {
XA_DEBUG_ASSERT(index >= 0 && index <= context->nb_variables - 1);
return NL_BUFFER_ITEM(context->variable_buffer[0], index);
}
static void nlLockVariable(NLContext *context, uint32_t index) {
XA_DEBUG_ASSERT(index >= 0 && index <= context->nb_variables - 1);
context->variable_is_locked[index] = true;
}
static void nlVariablesToVector(NLContext *context) {
uint32_t n = context->n;
XA_DEBUG_ASSERT(context->x);
for (uint32_t k = 0; k < context->nb_systems; ++k) {
for (uint32_t i = 0; i < context->nb_variables; ++i) {
if (!context->variable_is_locked[i]) {
uint32_t index = context->variable_index[i];
XA_DEBUG_ASSERT(index < context->n);
double value = NL_BUFFER_ITEM(context->variable_buffer[k], i);
context->x[index + k * n] = value;
}
}
}
}
static void nlVectorToVariables(NLContext *context) {
uint32_t n = context->n;
XA_DEBUG_ASSERT(context->x);
for (uint32_t k = 0; k < context->nb_systems; ++k) {
for (uint32_t i = 0; i < context->nb_variables; ++i) {
if (!context->variable_is_locked[i]) {
uint32_t index = context->variable_index[i];
XA_DEBUG_ASSERT(index < context->n);
double value = context->x[index + k * n];
NL_BUFFER_ITEM(context->variable_buffer[k], i) = value;
}
}
}
}
static void nlCoefficient(NLContext *context, uint32_t index, double value) {
XA_DEBUG_ASSERT(index >= 0 && index <= context->nb_variables - 1);
if (context->variable_is_locked[index]) {
/*
* Note: in al, indices are NLvariable indices,
* within [0..nb_variables-1]
*/
nlRowColumnAppend(&(context->al), index, value);
} else {
/*
* Note: in af, indices are system indices,
* within [0..n-1]
*/
nlRowColumnAppend(&(context->af), context->variable_index[index], value);
}
}
#define NL_SYSTEM 0x0
#define NL_MATRIX 0x1
#define NL_ROW 0x2
static void nlBegin(NLContext *context, uint32_t prim) {
if (prim == NL_SYSTEM) {
XA_DEBUG_ASSERT(context->nb_variables > 0);
context->variable_buffer = NL_NEW_ARRAY(NLBufferBinding, context->nb_systems);
NL_CLEAR_ARRAY(NLBufferBinding, context->variable_buffer, context->nb_systems);
context->variable_value = NL_NEW_ARRAY(double, context->nb_variables * context->nb_systems);
NL_CLEAR_ARRAY(double, context->variable_value, context->nb_variables * context->nb_systems);
for (uint32_t k = 0; k < context->nb_systems; ++k) {
context->variable_buffer[k].base_address =
context->variable_value +
k * context->nb_variables;
context->variable_buffer[k].stride = sizeof(double);
}
context->variable_is_locked = NL_NEW_ARRAY(bool, context->nb_variables);
NL_CLEAR_ARRAY(bool, context->variable_is_locked, context->nb_variables);
context->variable_index = NL_NEW_ARRAY(uint32_t, context->nb_variables);
NL_CLEAR_ARRAY(uint32_t, context->variable_index, context->nb_variables);
} else if (prim == NL_MATRIX) {
if (context->M)
return;
uint32_t n = 0;
for (uint32_t i = 0; i < context->nb_variables; i++) {
if (!context->variable_is_locked[i]) {
context->variable_index[i] = n;
n++;
} else
context->variable_index[i] = (uint32_t)~0;
}
context->n = n;
if (!context->max_iterations_defined)
context->max_iterations = n * 5;
context->M = (NLMatrix)(NL_NEW(NLSparseMatrix));
NL_CLEAR(context->M, NLSparseMatrix);
nlSparseMatrixConstruct((NLSparseMatrix *)(context->M), n, n);
context->x = NL_NEW_ARRAY(double, n * context->nb_systems);
NL_CLEAR_ARRAY(double, context->x, n * context->nb_systems);
context->b = NL_NEW_ARRAY(double, n * context->nb_systems);
NL_CLEAR_ARRAY(double, context->b, n * context->nb_systems);
nlVariablesToVector(context);
nlRowColumnConstruct(&context->af);
nlRowColumnConstruct(&context->al);
context->current_row = 0;
} else if (prim == NL_ROW) {
nlRowColumnZero(&context->af);
nlRowColumnZero(&context->al);
}
}
static void nlEnd(NLContext *context, uint32_t prim) {
if (prim == NL_MATRIX) {
nlRowColumnClear(&context->af);
nlRowColumnClear(&context->al);
} else if (prim == NL_ROW) {
NLRowColumn *af = &context->af;
NLRowColumn *al = &context->al;
NLSparseMatrix *M = (NLSparseMatrix *)context->M;
double *b = context->b;
uint32_t nf = af->size;
uint32_t nl = al->size;
uint32_t n = context->n;
double S;
/*
* least_squares : we want to solve
* A'A x = A'b
*/
for (uint32_t i = 0; i < nf; i++) {
for (uint32_t j = 0; j < nf; j++) {
nlSparseMatrixAdd(M, af->coeff[i].index, af->coeff[j].index, af->coeff[i].value * af->coeff[j].value);
}
}
for (uint32_t k = 0; k < context->nb_systems; ++k) {
S = 0.0;
for (uint32_t jj = 0; jj < nl; ++jj) {
uint32_t j = al->coeff[jj].index;
S += al->coeff[jj].value * NL_BUFFER_ITEM(context->variable_buffer[k], j);
}
for (uint32_t jj = 0; jj < nf; jj++)
b[k * n + af->coeff[jj].index] -= af->coeff[jj].value * S;
}
context->current_row++;
}
}
static bool nlSolve(NLContext *context) {
nlDeleteMatrix(context->P);
context->P = nlNewJacobiPreconditioner(context->M);
nlMatrixCompress(&context->M);
bool result = nlSolveIterative(context);
nlVectorToVariables(context);
return result;
}
} // namespace opennl
namespace raster {
class ClippedTriangle {
public:
ClippedTriangle(const Vector2 &a, const Vector2 &b, const Vector2 &c) {
m_numVertices = 3;
m_activeVertexBuffer = 0;
m_verticesA[0] = a;
m_verticesA[1] = b;
m_verticesA[2] = c;
m_vertexBuffers[0] = m_verticesA;
m_vertexBuffers[1] = m_verticesB;
m_area = 0;
}
void clipHorizontalPlane(float offset, float clipdirection) {
Vector2 *v = m_vertexBuffers[m_activeVertexBuffer];
m_activeVertexBuffer ^= 1;
Vector2 *v2 = m_vertexBuffers[m_activeVertexBuffer];
v[m_numVertices] = v[0];
float dy2, dy1 = offset - v[0].y;
int dy2in, dy1in = clipdirection * dy1 >= 0;
uint32_t p = 0;
for (uint32_t k = 0; k < m_numVertices; k++) {
dy2 = offset - v[k + 1].y;
dy2in = clipdirection * dy2 >= 0;
if (dy1in)
v2[p++] = v[k];
if (dy1in + dy2in == 1) { // not both in/out
float dx = v[k + 1].x - v[k].x;
float dy = v[k + 1].y - v[k].y;
v2[p++] = Vector2(v[k].x + dy1 * (dx / dy), offset);
}
dy1 = dy2;
dy1in = dy2in;
}
m_numVertices = p;
}
void clipVerticalPlane(float offset, float clipdirection) {
Vector2 *v = m_vertexBuffers[m_activeVertexBuffer];
m_activeVertexBuffer ^= 1;
Vector2 *v2 = m_vertexBuffers[m_activeVertexBuffer];
v[m_numVertices] = v[0];
float dx2, dx1 = offset - v[0].x;
int dx2in, dx1in = clipdirection * dx1 >= 0;
uint32_t p = 0;
for (uint32_t k = 0; k < m_numVertices; k++) {
dx2 = offset - v[k + 1].x;
dx2in = clipdirection * dx2 >= 0;
if (dx1in)
v2[p++] = v[k];
if (dx1in + dx2in == 1) { // not both in/out
float dx = v[k + 1].x - v[k].x;
float dy = v[k + 1].y - v[k].y;
v2[p++] = Vector2(offset, v[k].y + dx1 * (dy / dx));
}
dx1 = dx2;
dx1in = dx2in;
}
m_numVertices = p;
}
void computeArea() {
Vector2 *v = m_vertexBuffers[m_activeVertexBuffer];
v[m_numVertices] = v[0];
m_area = 0;
//float centroidx = 0, centroidy = 0;
for (uint32_t k = 0; k < m_numVertices; k++) {
// http://local.wasp.uwa.edu.au/~pbourke/geometry/polyarea/
float f = v[k].x * v[k + 1].y - v[k + 1].x * v[k].y;
m_area += f;
//centroidx += f * (v[k].x + v[k + 1].x);
//centroidy += f * (v[k].y + v[k + 1].y);
}
m_area = 0.5f * fabsf(m_area);
}
void clipAABox(float x0, float y0, float x1, float y1) {
clipVerticalPlane(x0, -1);
clipHorizontalPlane(y0, -1);
clipVerticalPlane(x1, 1);
clipHorizontalPlane(y1, 1);
computeArea();
}
float area() const {
return m_area;
}
private:
Vector2 m_verticesA[7 + 1];
Vector2 m_verticesB[7 + 1];
Vector2 *m_vertexBuffers[2];
uint32_t m_numVertices;
uint32_t m_activeVertexBuffer;
float m_area;
};
/// A callback to sample the environment. Return false to terminate rasterization.
typedef bool (*SamplingCallback)(void *param, int x, int y);
/// A triangle for rasterization.
struct Triangle {
Triangle(const Vector2 &_v0, const Vector2 &_v1, const Vector2 &_v2) :
v1(_v0), v2(_v2), v3(_v1), n1(0.0f), n2(0.0f), n3(0.0f) {
// make sure every triangle is front facing.
flipBackface();
// Compute deltas.
if (isValid())
computeUnitInwardNormals();
}
bool isValid() {
const Vector2 e0 = v3 - v1;
const Vector2 e1 = v2 - v1;
const float area = e0.y * e1.x - e1.y * e0.x;
return area != 0.0f;
}
// extents has to be multiple of BK_SIZE!!
bool drawAA(const Vector2 &extents, SamplingCallback cb, void *param) {
const float PX_INSIDE = 1.0f / sqrtf(2.0f);
const float PX_OUTSIDE = -1.0f / sqrtf(2.0f);
const float BK_SIZE = 8;
const float BK_INSIDE = sqrtf(BK_SIZE * BK_SIZE / 2.0f);
const float BK_OUTSIDE = -sqrtf(BK_SIZE * BK_SIZE / 2.0f);
// Bounding rectangle
float minx = floorf(max(min3(v1.x, v2.x, v3.x), 0.0f));
float miny = floorf(max(min3(v1.y, v2.y, v3.y), 0.0f));
float maxx = ceilf(min(max3(v1.x, v2.x, v3.x), extents.x - 1.0f));
float maxy = ceilf(min(max3(v1.y, v2.y, v3.y), extents.y - 1.0f));
// There's no reason to align the blocks to the viewport, instead we align them to the origin of the triangle bounds.
minx = floorf(minx);
miny = floorf(miny);
//minx = (float)(((int)minx) & (~((int)BK_SIZE - 1))); // align to blocksize (we don't need to worry about blocks partially out of viewport)
//miny = (float)(((int)miny) & (~((int)BK_SIZE - 1)));
minx += 0.5;
miny += 0.5; // sampling at texel centers!
maxx += 0.5;
maxy += 0.5;
// Half-edge constants
float C1 = n1.x * (-v1.x) + n1.y * (-v1.y);
float C2 = n2.x * (-v2.x) + n2.y * (-v2.y);
float C3 = n3.x * (-v3.x) + n3.y * (-v3.y);
// Loop through blocks
for (float y0 = miny; y0 <= maxy; y0 += BK_SIZE) {
for (float x0 = minx; x0 <= maxx; x0 += BK_SIZE) {
// Corners of block
float xc = (x0 + (BK_SIZE - 1) / 2.0f);
float yc = (y0 + (BK_SIZE - 1) / 2.0f);
// Evaluate half-space functions
float aC = C1 + n1.x * xc + n1.y * yc;
float bC = C2 + n2.x * xc + n2.y * yc;
float cC = C3 + n3.x * xc + n3.y * yc;
// Skip block when outside an edge
if ((aC <= BK_OUTSIDE) || (bC <= BK_OUTSIDE) || (cC <= BK_OUTSIDE))
continue;
// Accept whole block when totally covered
if ((aC >= BK_INSIDE) && (bC >= BK_INSIDE) && (cC >= BK_INSIDE)) {
for (float y = y0; y < y0 + BK_SIZE; y++) {
for (float x = x0; x < x0 + BK_SIZE; x++) {
if (!cb(param, (int)x, (int)y))
return false;
}
}
} else { // Partially covered block
float CY1 = C1 + n1.x * x0 + n1.y * y0;
float CY2 = C2 + n2.x * x0 + n2.y * y0;
float CY3 = C3 + n3.x * x0 + n3.y * y0;
for (float y = y0; y < y0 + BK_SIZE; y++) { // @@ This is not clipping to scissor rectangle correctly.
float CX1 = CY1;
float CX2 = CY2;
float CX3 = CY3;
for (float x = x0; x < x0 + BK_SIZE; x++) { // @@ This is not clipping to scissor rectangle correctly.
if (CX1 >= PX_INSIDE && CX2 >= PX_INSIDE && CX3 >= PX_INSIDE) {
if (!cb(param, (int)x, (int)y))
return false;
} else if ((CX1 >= PX_OUTSIDE) && (CX2 >= PX_OUTSIDE) && (CX3 >= PX_OUTSIDE)) {
// triangle partially covers pixel. do clipping.
ClippedTriangle ct(v1 - Vector2(x, y), v2 - Vector2(x, y), v3 - Vector2(x, y));
ct.clipAABox(-0.5, -0.5, 0.5, 0.5);
if (ct.area() > 0.0f) {
if (!cb(param, (int)x, (int)y))
return false;
}
}
CX1 += n1.x;
CX2 += n2.x;
CX3 += n3.x;
}
CY1 += n1.y;
CY2 += n2.y;
CY3 += n3.y;
}
}
}
}
return true;
}
private:
void flipBackface() {
// check if triangle is backfacing, if so, swap two vertices
if (((v3.x - v1.x) * (v2.y - v1.y) - (v3.y - v1.y) * (v2.x - v1.x)) < 0) {
Vector2 hv = v1;
v1 = v2;
v2 = hv; // swap pos
}
}
// compute unit inward normals for each edge.
void computeUnitInwardNormals() {
n1 = v1 - v2;
n1 = Vector2(-n1.y, n1.x);
n1 = n1 * (1.0f / sqrtf(dot(n1, n1)));
n2 = v2 - v3;
n2 = Vector2(-n2.y, n2.x);
n2 = n2 * (1.0f / sqrtf(dot(n2, n2)));
n3 = v3 - v1;
n3 = Vector2(-n3.y, n3.x);
n3 = n3 * (1.0f / sqrtf(dot(n3, n3)));
}
// Vertices.
Vector2 v1, v2, v3;
Vector2 n1, n2, n3; // unit inward normals
};
// Process the given triangle. Returns false if rasterization was interrupted by the callback.
static bool drawTriangle(const Vector2 &extents, const Vector2 v[3], SamplingCallback cb, void *param) {
Triangle tri(v[0], v[1], v[2]);
// @@ It would be nice to have a conservative drawing mode that enlarges the triangle extents by one texel and is able to handle degenerate triangles.
// @@ Maybe the simplest thing to do would be raster triangle edges.
if (tri.isValid())
return tri.drawAA(extents, cb, param);
return true;
}
} // namespace raster
namespace segment {
// - Insertion is o(n)
// - Smallest element goes at the end, so that popping it is o(1).
struct CostQueue {
CostQueue(uint32_t size = UINT32_MAX) :
m_maxSize(size), m_pairs(MemTag::SegmentAtlasChartCandidates) {}
float peekCost() const {
return m_pairs.back().cost;
}
uint32_t peekFace() const {
return m_pairs.back().face;
}
void push(float cost, uint32_t face) {
const Pair p = { cost, face };
if (m_pairs.isEmpty() || cost < peekCost())
m_pairs.push_back(p);
else {
uint32_t i = 0;
const uint32_t count = m_pairs.size();
for (; i < count; i++) {
if (m_pairs[i].cost < cost)
break;
}
m_pairs.insertAt(i, p);
if (m_pairs.size() > m_maxSize)
m_pairs.removeAt(0);
}
}
uint32_t pop() {
XA_DEBUG_ASSERT(!m_pairs.isEmpty());
uint32_t f = m_pairs.back().face;
m_pairs.pop_back();
return f;
}
XA_INLINE void clear() {
m_pairs.clear();
}
XA_INLINE uint32_t count() const {
return m_pairs.size();
}
private:
const uint32_t m_maxSize;
struct Pair {
float cost;
uint32_t face;
};
Array<Pair> m_pairs;
};
struct AtlasData {
ChartOptions options;
const Mesh *mesh = nullptr;
Array<float> edgeDihedralAngles;
Array<float> edgeLengths;
Array<float> faceAreas;
Array<float> faceUvAreas; // Can be negative.
Array<Vector3> faceNormals;
BitArray isFaceInChart;
AtlasData() :
edgeDihedralAngles(MemTag::SegmentAtlasMeshData), edgeLengths(MemTag::SegmentAtlasMeshData), faceAreas(MemTag::SegmentAtlasMeshData), faceNormals(MemTag::SegmentAtlasMeshData) {}
void compute() {
const uint32_t faceCount = mesh->faceCount();
const uint32_t edgeCount = mesh->edgeCount();
edgeDihedralAngles.resize(edgeCount);
edgeLengths.resize(edgeCount);
faceAreas.resize(faceCount);
//if (options.useInputMeshUvs)
faceUvAreas.resize(faceCount);
faceNormals.resize(faceCount);
isFaceInChart.resize(faceCount);
isFaceInChart.zeroOutMemory();
for (uint32_t f = 0; f < faceCount; f++) {
for (uint32_t i = 0; i < 3; i++) {
const uint32_t edge = f * 3 + i;
const Vector3 &p0 = mesh->position(mesh->vertexAt(meshEdgeIndex0(edge)));
const Vector3 &p1 = mesh->position(mesh->vertexAt(meshEdgeIndex1(edge)));
edgeLengths[edge] = length(p1 - p0);
XA_DEBUG_ASSERT(edgeLengths[edge] > 0.0f);
}
faceAreas[f] = mesh->computeFaceArea(f);
XA_DEBUG_ASSERT(faceAreas[f] > 0.0f);
//if (options.useInputMeshUvs)
// faceUvAreas[f] = mesh->computeFaceParametricArea(f);
faceNormals[f] = mesh->computeFaceNormal(f);
}
for (uint32_t face = 0; face < faceCount; face++) {
for (uint32_t i = 0; i < 3; i++) {
const uint32_t edge = face * 3 + i;
const uint32_t oedge = mesh->oppositeEdge(edge);
if (oedge == UINT32_MAX)
edgeDihedralAngles[edge] = FLT_MAX;
else {
const uint32_t oface = meshEdgeFace(oedge);
edgeDihedralAngles[edge] = edgeDihedralAngles[oedge] = dot(faceNormals[face], faceNormals[oface]);
}
}
}
}
};
// If MeshDecl::vertexUvData is set on input meshes, find charts by floodfilling faces in world/model space without crossing UV seams.
struct OriginalUvCharts {
OriginalUvCharts(AtlasData &data) :
m_data(data) {}
uint32_t chartCount() const { return m_charts.size(); }
const Basis &chartBasis(uint32_t chartIndex) const { return m_chartBasis[chartIndex]; }
ConstArrayView<uint32_t> chartFaces(uint32_t chartIndex) const {
const Chart &chart = m_charts[chartIndex];
return ConstArrayView<uint32_t>(&m_chartFaces[chart.firstFace], chart.faceCount);
}
void compute() {
m_charts.clear();
m_chartFaces.clear();
const Mesh *mesh = m_data.mesh;
const uint32_t faceCount = mesh->faceCount();
for (uint32_t f = 0; f < faceCount; f++) {
if (m_data.isFaceInChart.get(f))
continue;
//if (isZero(m_data.faceUvAreas[f], kAreaEpsilon))
// continue; // Face must have valid UVs.
// Found an unassigned face, create a new chart.
Chart chart;
chart.firstFace = m_chartFaces.size();
chart.faceCount = 1;
m_chartFaces.push_back(f);
m_data.isFaceInChart.set(f);
floodfillFaces(chart);
m_charts.push_back(chart);
}
// Compute basis for each chart.
m_chartBasis.resize(m_charts.size());
for (uint32_t c = 0; c < m_charts.size(); c++) {
const Chart &chart = m_charts[c];
m_tempPoints.resize(chart.faceCount * 3);
for (uint32_t f = 0; f < chart.faceCount; f++) {
const uint32_t face = m_chartFaces[chart.firstFace + f];
for (uint32_t i = 0; i < 3; i++)
m_tempPoints[f * 3 + i] = m_data.mesh->position(m_data.mesh->vertexAt(face * 3 + i));
}
Fit::computeBasis(m_tempPoints, &m_chartBasis[c]);
}
}
private:
struct Chart {
uint32_t firstFace, faceCount;
};
void floodfillFaces(Chart &chart) {
//const bool isFaceAreaNegative = m_data.faceUvAreas[m_chartFaces[chart.firstFace]] < 0.0f;
for (;;) {
bool newFaceAdded = false;
const uint32_t faceCount = chart.faceCount;
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t sourceFace = m_chartFaces[chart.firstFace + f];
for (Mesh::FaceEdgeIterator edgeIt(m_data.mesh, sourceFace); !edgeIt.isDone(); edgeIt.advance()) {
const uint32_t face = edgeIt.oppositeFace();
if (face == UINT32_MAX)
continue; // Boundary edge.
if (m_data.isFaceInChart.get(face))
continue; // Already assigned to a chart.
//if (isZero(m_data.faceUvAreas[face], kAreaEpsilon))
// continue; // Face must have valid UVs.
//if ((m_data.faceUvAreas[face] < 0.0f) != isFaceAreaNegative)
// continue; // Face winding is opposite of the first chart face.
//const Vector2 &uv0 = m_data.mesh->texcoord(edgeIt.vertex0());
//const Vector2 &uv1 = m_data.mesh->texcoord(edgeIt.vertex1());
//const Vector2 &ouv0 = m_data.mesh->texcoord(m_data.mesh->vertexAt(meshEdgeIndex0(edgeIt.oppositeEdge())));
//const Vector2 &ouv1 = m_data.mesh->texcoord(m_data.mesh->vertexAt(meshEdgeIndex1(edgeIt.oppositeEdge())));
//if (!equal(uv0, ouv1, m_data.mesh->epsilon()) || !equal(uv1, ouv0, m_data.mesh->epsilon()))
// continue; // UVs must match exactly.
m_chartFaces.push_back(face);
chart.faceCount++;
m_data.isFaceInChart.set(face);
newFaceAdded = true;
}
}
if (!newFaceAdded)
break;
}
}
void floodfillFacesWithUV(Chart &chart) {
const bool isFaceAreaNegative = m_data.faceUvAreas[m_chartFaces[chart.firstFace]] < 0.0f;
for (;;) {
bool newFaceAdded = false;
const uint32_t faceCount = chart.faceCount;
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t sourceFace = m_chartFaces[chart.firstFace + f];
for (Mesh::FaceEdgeIterator edgeIt(m_data.mesh, sourceFace); !edgeIt.isDone(); edgeIt.advance()) {
const uint32_t face = edgeIt.oppositeFace();
if (face == UINT32_MAX)
continue; // Boundary edge.
if (m_data.isFaceInChart.get(face))
continue; // Already assigned to a chart.
if (isZero(m_data.faceUvAreas[face], kAreaEpsilon))
continue; // Face must have valid UVs.
if ((m_data.faceUvAreas[face] < 0.0f) != isFaceAreaNegative)
continue; // Face winding is opposite of the first chart face.
const Vector2 &uv0 = m_data.mesh->texcoord(edgeIt.vertex0());
const Vector2 &uv1 = m_data.mesh->texcoord(edgeIt.vertex1());
const Vector2 &ouv0 = m_data.mesh->texcoord(m_data.mesh->vertexAt(meshEdgeIndex0(edgeIt.oppositeEdge())));
const Vector2 &ouv1 = m_data.mesh->texcoord(m_data.mesh->vertexAt(meshEdgeIndex1(edgeIt.oppositeEdge())));
if (!equal(uv0, ouv1, m_data.mesh->epsilon()) || !equal(uv1, ouv0, m_data.mesh->epsilon()))
continue; // UVs must match exactly.
m_chartFaces.push_back(face);
chart.faceCount++;
m_data.isFaceInChart.set(face);
newFaceAdded = true;
}
}
if (!newFaceAdded)
break;
}
}
AtlasData &m_data;
Array<Chart> m_charts;
Array<Basis> m_chartBasis;
Array<uint32_t> m_chartFaces;
Array<Vector3> m_tempPoints;
};
#if XA_DEBUG_EXPORT_OBJ_PLANAR_REGIONS
static uint32_t s_planarRegionsCurrentRegion;
static uint32_t s_planarRegionsCurrentVertex;
#endif
struct ChartGeneratorType {
enum Enum {
OriginalUv,
Piecewise
};
};
struct Atlas {
Atlas() :
m_originalUvCharts(m_data) {}
uint32_t chartCount() const {
return m_originalUvCharts.chartCount();
}
ConstArrayView<uint32_t> chartFaces(uint32_t chartIndex) const {
return m_originalUvCharts.chartFaces(chartIndex);
}
const Basis &chartBasis(uint32_t chartIndex) const {
return m_originalUvCharts.chartBasis(chartIndex);
}
ChartGeneratorType::Enum chartGeneratorType(uint32_t chartIndex) const {
//return ChartGeneratorType::OriginalUv;
return ChartGeneratorType::Piecewise;
}
void reset(const Mesh *mesh, const ChartOptions &options) {
XA_PROFILE_START(buildAtlasInit)
m_data.options = options;
m_data.mesh = mesh;
m_data.compute();
XA_PROFILE_END(buildAtlasInit)
}
void compute() {
XA_PROFILE_START(originalUvCharts)
m_originalUvCharts.compute();
XA_PROFILE_END(originalUvCharts)
}
private:
AtlasData m_data;
OriginalUvCharts m_originalUvCharts;
};
struct ComputeUvMeshChartsTaskArgs {
UvMesh *mesh;
Progress *progress;
};
// Charts are found by floodfilling faces without crossing UV seams.
struct ComputeUvMeshChartsTask {
ComputeUvMeshChartsTask(ComputeUvMeshChartsTaskArgs *args) :
m_mesh(args->mesh), m_progress(args->progress), m_uvToEdgeMap(MemTag::Default, m_mesh->indices.size()), m_faceAssigned(m_mesh->indices.size() / 3) {}
void run() {
const uint32_t vertexCount = m_mesh->texcoords.size();
const uint32_t indexCount = m_mesh->indices.size();
const uint32_t faceCount = indexCount / 3;
// A vertex can only be assigned to one chart.
m_mesh->vertexToChartMap.resize(vertexCount);
m_mesh->vertexToChartMap.fill(UINT32_MAX);
// Map vertex UV to edge. Face is then edge / 3.
for (uint32_t i = 0; i < indexCount; i++)
m_uvToEdgeMap.add(m_mesh->texcoords[m_mesh->indices[i]]);
// Find charts.
m_faceAssigned.zeroOutMemory();
for (uint32_t f = 0; f < faceCount; f++) {
if (m_progress->cancel)
return;
m_progress->increment(1);
// Found an unassigned face, see if it can be added.
const uint32_t chartIndex = m_mesh->charts.size();
if (!canAddFaceToChart(chartIndex, f))
continue;
// Face is OK, create a new chart with the face.
UvMeshChart *chart = XA_NEW(MemTag::Default, UvMeshChart);
m_mesh->charts.push_back(chart);
chart->material = m_mesh->faceMaterials.isEmpty() ? 0 : m_mesh->faceMaterials[f];
addFaceToChart(chartIndex, f);
// Walk incident faces and assign them to the chart.
uint32_t f2 = 0;
for (;;) {
bool newFaceAssigned = false;
const uint32_t faceCount2 = chart->faces.size();
for (; f2 < faceCount2; f2++) {
const uint32_t face = chart->faces[f2];
for (uint32_t i = 0; i < 3; i++) {
// Add any valid faces with colocal UVs to the chart.
const Vector2 &uv = m_mesh->texcoords[m_mesh->indices[face * 3 + i]];
uint32_t edge = m_uvToEdgeMap.get(uv);
while (edge != UINT32_MAX) {
const uint32_t newFace = edge / 3;
if (canAddFaceToChart(chartIndex, newFace)) {
addFaceToChart(chartIndex, newFace);
newFaceAssigned = true;
}
edge = m_uvToEdgeMap.getNext(uv, edge);
}
}
}
if (!newFaceAssigned)
break;
}
}
}
private:
// The chart at chartIndex doesn't have to exist yet.
bool canAddFaceToChart(uint32_t chartIndex, uint32_t face) const {
if (m_faceAssigned.get(face))
return false; // Already assigned to a chart.
if (m_mesh->faceIgnore.get(face))
return false; // Face is ignored (zero area or nan UVs).
if (!m_mesh->faceMaterials.isEmpty() && chartIndex < m_mesh->charts.size()) {
if (m_mesh->faceMaterials[face] != m_mesh->charts[chartIndex]->material)
return false; // Materials don't match.
}
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = m_mesh->indices[face * 3 + i];
if (m_mesh->vertexToChartMap[vertex] != UINT32_MAX && m_mesh->vertexToChartMap[vertex] != chartIndex)
return false; // Vertex already assigned to another chart.
}
return true;
}
void addFaceToChart(uint32_t chartIndex, uint32_t face) {
UvMeshChart *chart = m_mesh->charts[chartIndex];
m_faceAssigned.set(face);
chart->faces.push_back(face);
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = m_mesh->indices[face * 3 + i];
m_mesh->vertexToChartMap[vertex] = chartIndex;
chart->indices.push_back(vertex);
}
}
UvMesh *const m_mesh;
Progress *const m_progress;
HashMap<Vector2> m_uvToEdgeMap; // Face is edge / 3.
BitArray m_faceAssigned;
};
static void runComputeUvMeshChartsTask(void * /*groupUserData*/, void *taskUserData) {
XA_PROFILE_START(computeChartsThread)
ComputeUvMeshChartsTask task((ComputeUvMeshChartsTaskArgs *)taskUserData);
task.run();
XA_PROFILE_END(computeChartsThread)
}
static bool computeUvMeshCharts(TaskScheduler *taskScheduler, ArrayView<UvMesh *> meshes, ProgressFunc progressFunc, void *progressUserData) {
uint32_t totalFaceCount = 0;
for (uint32_t i = 0; i < meshes.length; i++)
totalFaceCount += meshes[i]->indices.size() / 3;
Progress progress(ProgressCategory::ComputeCharts, progressFunc, progressUserData, totalFaceCount);
TaskGroupHandle taskGroup = taskScheduler->createTaskGroup(nullptr, meshes.length);
Array<ComputeUvMeshChartsTaskArgs> taskArgs;
taskArgs.resize(meshes.length);
for (uint32_t i = 0; i < meshes.length; i++) {
ComputeUvMeshChartsTaskArgs &args = taskArgs[i];
args.mesh = meshes[i];
args.progress = &progress;
Task task;
task.userData = &args;
task.func = runComputeUvMeshChartsTask;
taskScheduler->run(taskGroup, task);
}
taskScheduler->wait(&taskGroup);
return !progress.cancel;
}
} // namespace segment
namespace param {
// Fast sweep in 3 directions
static bool findApproximateDiameterVertices(Mesh *mesh, uint32_t *a, uint32_t *b) {
XA_DEBUG_ASSERT(a != nullptr);
XA_DEBUG_ASSERT(b != nullptr);
const uint32_t vertexCount = mesh->vertexCount();
uint32_t minVertex[3];
uint32_t maxVertex[3];
minVertex[0] = minVertex[1] = minVertex[2] = UINT32_MAX;
maxVertex[0] = maxVertex[1] = maxVertex[2] = UINT32_MAX;
for (uint32_t v = 1; v < vertexCount; v++) {
if (mesh->isBoundaryVertex(v)) {
minVertex[0] = minVertex[1] = minVertex[2] = v;
maxVertex[0] = maxVertex[1] = maxVertex[2] = v;
break;
}
}
if (minVertex[0] == UINT32_MAX) {
// Input mesh has not boundaries.
return false;
}
for (uint32_t v = 1; v < vertexCount; v++) {
if (!mesh->isBoundaryVertex(v)) {
// Skip interior vertices.
continue;
}
const Vector3 &pos = mesh->position(v);
if (pos.x < mesh->position(minVertex[0]).x)
minVertex[0] = v;
else if (pos.x > mesh->position(maxVertex[0]).x)
maxVertex[0] = v;
if (pos.y < mesh->position(minVertex[1]).y)
minVertex[1] = v;
else if (pos.y > mesh->position(maxVertex[1]).y)
maxVertex[1] = v;
if (pos.z < mesh->position(minVertex[2]).z)
minVertex[2] = v;
else if (pos.z > mesh->position(maxVertex[2]).z)
maxVertex[2] = v;
}
float lengths[3];
for (int i = 0; i < 3; i++) {
lengths[i] = length(mesh->position(minVertex[i]) - mesh->position(maxVertex[i]));
}
if (lengths[0] > lengths[1] && lengths[0] > lengths[2]) {
*a = minVertex[0];
*b = maxVertex[0];
} else if (lengths[1] > lengths[2]) {
*a = minVertex[1];
*b = maxVertex[1];
} else {
*a = minVertex[2];
*b = maxVertex[2];
}
return true;
}
// From OpenNL LSCM example.
// Computes the coordinates of the vertices of a triangle in a local 2D orthonormal basis of the triangle's plane.
static void projectTriangle(Vector3 p0, Vector3 p1, Vector3 p2, Vector2 *z0, Vector2 *z1, Vector2 *z2) {
Vector3 X = normalize(p1 - p0);
Vector3 Z = normalize(cross(X, p2 - p0));
Vector3 Y = cross(Z, X);
Vector3 &O = p0;
*z0 = Vector2(0, 0);
*z1 = Vector2(length(p1 - O), 0);
*z2 = Vector2(dot(p2 - O, X), dot(p2 - O, Y));
}
// Conformal relations from Brecht Van Lommel (based on ABF):
static float vec_angle_cos(const Vector3 &v1, const Vector3 &v2, const Vector3 &v3) {
Vector3 d1 = v1 - v2;
Vector3 d2 = v3 - v2;
return clamp(dot(d1, d2) / (length(d1) * length(d2)), -1.0f, 1.0f);
}
static float vec_angle(const Vector3 &v1, const Vector3 &v2, const Vector3 &v3) {
float dot = vec_angle_cos(v1, v2, v3);
return acosf(dot);
}
static void triangle_angles(const Vector3 &v1, const Vector3 &v2, const Vector3 &v3, float *a1, float *a2, float *a3) {
*a1 = vec_angle(v3, v1, v2);
*a2 = vec_angle(v1, v2, v3);
*a3 = kPi - *a2 - *a1;
}
static bool setup_abf_relations(opennl::NLContext *context, int id0, int id1, int id2, const Vector3 &p0, const Vector3 &p1, const Vector3 &p2) {
// @@ IC: Wouldn't it be more accurate to return cos and compute 1-cos^2?
// It does indeed seem to be a little bit more robust.
// @@ Need to revisit this more carefully!
float a0, a1, a2;
triangle_angles(p0, p1, p2, &a0, &a1, &a2);
if (a0 == 0.0f || a1 == 0.0f || a2 == 0.0f)
return false;
float s0 = sinf(a0);
float s1 = sinf(a1);
float s2 = sinf(a2);
if (s1 > s0 && s1 > s2) {
swap(s1, s2);
swap(s0, s1);
swap(a1, a2);
swap(a0, a1);
swap(id1, id2);
swap(id0, id1);
} else if (s0 > s1 && s0 > s2) {
swap(s0, s2);
swap(s0, s1);
swap(a0, a2);
swap(a0, a1);
swap(id0, id2);
swap(id0, id1);
}
float c0 = cosf(a0);
float ratio = (s2 == 0.0f) ? 1.0f : s1 / s2;
float cosine = c0 * ratio;
float sine = s0 * ratio;
// Note : 2*id + 0 --> u
// 2*id + 1 --> v
int u0_id = 2 * id0 + 0;
int v0_id = 2 * id0 + 1;
int u1_id = 2 * id1 + 0;
int v1_id = 2 * id1 + 1;
int u2_id = 2 * id2 + 0;
int v2_id = 2 * id2 + 1;
// Real part
opennl::nlBegin(context, NL_ROW);
opennl::nlCoefficient(context, u0_id, cosine - 1.0f);
opennl::nlCoefficient(context, v0_id, -sine);
opennl::nlCoefficient(context, u1_id, -cosine);
opennl::nlCoefficient(context, v1_id, sine);
opennl::nlCoefficient(context, u2_id, 1);
opennl::nlEnd(context, NL_ROW);
// Imaginary part
opennl::nlBegin(context, NL_ROW);
opennl::nlCoefficient(context, u0_id, sine);
opennl::nlCoefficient(context, v0_id, cosine - 1.0f);
opennl::nlCoefficient(context, u1_id, -sine);
opennl::nlCoefficient(context, v1_id, -cosine);
opennl::nlCoefficient(context, v2_id, 1);
opennl::nlEnd(context, NL_ROW);
return true;
}
static bool computeLeastSquaresConformalMap(Mesh *mesh) {
uint32_t lockedVertex0, lockedVertex1;
if (!findApproximateDiameterVertices(mesh, &lockedVertex0, &lockedVertex1)) {
// Mesh has no boundaries.
return false;
}
const uint32_t vertexCount = mesh->vertexCount();
opennl::NLContext *context = opennl::nlNewContext();
opennl::nlSolverParameteri(context, NL_NB_VARIABLES, int(2 * vertexCount));
opennl::nlSolverParameteri(context, NL_MAX_ITERATIONS, int(5 * vertexCount));
opennl::nlBegin(context, NL_SYSTEM);
ArrayView<Vector2> texcoords = mesh->texcoords();
for (uint32_t i = 0; i < vertexCount; i++) {
opennl::nlSetVariable(context, 2 * i, texcoords[i].x);
opennl::nlSetVariable(context, 2 * i + 1, texcoords[i].y);
if (i == lockedVertex0 || i == lockedVertex1) {
opennl::nlLockVariable(context, 2 * i);
opennl::nlLockVariable(context, 2 * i + 1);
}
}
opennl::nlBegin(context, NL_MATRIX);
const uint32_t faceCount = mesh->faceCount();
ConstArrayView<Vector3> positions = mesh->positions();
ConstArrayView<uint32_t> indices = mesh->indices();
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t v0 = indices[f * 3 + 0];
const uint32_t v1 = indices[f * 3 + 1];
const uint32_t v2 = indices[f * 3 + 2];
if (!setup_abf_relations(context, v0, v1, v2, positions[v0], positions[v1], positions[v2])) {
Vector2 z0, z1, z2;
projectTriangle(positions[v0], positions[v1], positions[v2], &z0, &z1, &z2);
double a = z1.x - z0.x;
double b = z1.y - z0.y;
double c = z2.x - z0.x;
double d = z2.y - z0.y;
XA_DEBUG_ASSERT(b == 0.0);
// Note : 2*id + 0 --> u
// 2*id + 1 --> v
uint32_t u0_id = 2 * v0;
uint32_t v0_id = 2 * v0 + 1;
uint32_t u1_id = 2 * v1;
uint32_t v1_id = 2 * v1 + 1;
uint32_t u2_id = 2 * v2;
uint32_t v2_id = 2 * v2 + 1;
// Note : b = 0
// Real part
opennl::nlBegin(context, NL_ROW);
opennl::nlCoefficient(context, u0_id, -a + c);
opennl::nlCoefficient(context, v0_id, b - d);
opennl::nlCoefficient(context, u1_id, -c);
opennl::nlCoefficient(context, v1_id, d);
opennl::nlCoefficient(context, u2_id, a);
opennl::nlEnd(context, NL_ROW);
// Imaginary part
opennl::nlBegin(context, NL_ROW);
opennl::nlCoefficient(context, u0_id, -b + d);
opennl::nlCoefficient(context, v0_id, -a + c);
opennl::nlCoefficient(context, u1_id, -d);
opennl::nlCoefficient(context, v1_id, -c);
opennl::nlCoefficient(context, v2_id, a);
opennl::nlEnd(context, NL_ROW);
}
}
opennl::nlEnd(context, NL_MATRIX);
opennl::nlEnd(context, NL_SYSTEM);
if (!opennl::nlSolve(context)) {
opennl::nlDeleteContext(context);
return false;
}
for (uint32_t i = 0; i < vertexCount; i++) {
const double u = opennl::nlGetVariable(context, 2 * i);
const double v = opennl::nlGetVariable(context, 2 * i + 1);
texcoords[i] = Vector2((float)u, (float)v);
XA_DEBUG_ASSERT(!isNan(mesh->texcoord(i).x));
XA_DEBUG_ASSERT(!isNan(mesh->texcoord(i).y));
}
opennl::nlDeleteContext(context);
return true;
}
struct PiecewiseParam {
void reset(const Mesh *mesh) {
m_mesh = mesh;
const uint32_t faceCount = m_mesh->faceCount();
const uint32_t vertexCount = m_mesh->vertexCount();
m_texcoords.resize(vertexCount);
m_patch.reserve(faceCount);
m_candidates.reserve(faceCount);
m_faceInAnyPatch.resize(faceCount);
m_faceInAnyPatch.zeroOutMemory();
m_faceInvalid.resize(faceCount);
m_faceInPatch.resize(faceCount);
m_vertexInPatch.resize(vertexCount);
m_faceToCandidate.resize(faceCount);
}
ConstArrayView<uint32_t> chartFaces() const { return m_patch; }
ConstArrayView<Vector2> texcoords() const { return m_texcoords; }
bool computeChart() {
// Clear per-patch state.
m_patch.clear();
m_candidates.clear();
m_faceToCandidate.zeroOutMemory();
m_faceInvalid.zeroOutMemory();
m_faceInPatch.zeroOutMemory();
m_vertexInPatch.zeroOutMemory();
// Add the seed face (first unassigned face) to the patch.
const uint32_t faceCount = m_mesh->faceCount();
uint32_t seed = UINT32_MAX;
for (uint32_t f = 0; f < faceCount; f++) {
if (m_faceInAnyPatch.get(f))
continue;
seed = f;
// Add all 3 vertices.
Vector2 texcoords[3];
orthoProjectFace(seed, texcoords);
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = m_mesh->vertexAt(seed * 3 + i);
m_vertexInPatch.set(vertex);
m_texcoords[vertex] = texcoords[i];
}
addFaceToPatch(seed);
// Initialize the boundary grid.
m_boundaryGrid.reset(m_texcoords, m_mesh->indices());
for (Mesh::FaceEdgeIterator it(m_mesh, seed); !it.isDone(); it.advance())
m_boundaryGrid.append(it.edge());
break;
}
if (seed == UINT32_MAX)
return false;
for (;;) {
// Find the candidate with the lowest cost.
float lowestCost = FLT_MAX;
Candidate *bestCandidate = nullptr;
for (uint32_t i = 0; i < m_candidates.size(); i++) {
Candidate *candidate = m_candidates[i];
if (candidate->maxCost < lowestCost) {
lowestCost = candidate->maxCost;
bestCandidate = candidate;
}
}
if (!bestCandidate)
break;
XA_DEBUG_ASSERT(!bestCandidate->prev); // Must be head of linked candidates.
// Compute the position by averaging linked candidates (candidates that share the same free vertex).
Vector2 position(0.0f);
uint32_t n = 0;
for (CandidateIterator it(bestCandidate); !it.isDone(); it.advance()) {
position += it.current()->position;
n++;
}
position *= 1.0f / (float)n;
const uint32_t freeVertex = bestCandidate->vertex;
XA_DEBUG_ASSERT(!isNan(position.x));
XA_DEBUG_ASSERT(!isNan(position.y));
m_texcoords[freeVertex] = position;
// Check for flipped faces. This is also done when candidates are first added, but the averaged position of the free vertex is different now, so check again.
bool invalid = false;
for (CandidateIterator it(bestCandidate); !it.isDone(); it.advance()) {
const uint32_t vertex0 = m_mesh->vertexAt(meshEdgeIndex0(it.current()->patchEdge));
const uint32_t vertex1 = m_mesh->vertexAt(meshEdgeIndex1(it.current()->patchEdge));
const float freeVertexOrient = orientToEdge(m_texcoords[vertex0], m_texcoords[vertex1], position);
if ((it.current()->patchVertexOrient < 0.0f && freeVertexOrient < 0.0f) || (it.current()->patchVertexOrient > 0.0f && freeVertexOrient > 0.0f)) {
invalid = true;
break;
}
}
// Check for zero area and flipped faces (using area).
for (CandidateIterator it(bestCandidate); !it.isDone(); it.advance()) {
const Vector2 a = m_texcoords[m_mesh->vertexAt(it.current()->face * 3 + 0)];
const Vector2 b = m_texcoords[m_mesh->vertexAt(it.current()->face * 3 + 1)];
const Vector2 c = m_texcoords[m_mesh->vertexAt(it.current()->face * 3 + 2)];
const float area = triangleArea(a, b, c);
if (area <= 0.0f) {
invalid = true;
break;
}
}
// Check for boundary intersection.
if (!invalid) {
XA_PROFILE_START(parameterizeChartsPiecewiseBoundaryIntersection)
// Test candidate edges that would form part of the new patch boundary.
// Ignore boundary edges that would become internal if the candidate faces were added to the patch.
m_newBoundaryEdges.clear();
m_ignoreBoundaryEdges.clear();
for (CandidateIterator candidateIt(bestCandidate); !candidateIt.isDone(); candidateIt.advance()) {
for (Mesh::FaceEdgeIterator it(m_mesh, candidateIt.current()->face); !it.isDone(); it.advance()) {
const uint32_t oface = it.oppositeFace();
if (oface == UINT32_MAX || !m_faceInPatch.get(oface))
m_newBoundaryEdges.push_back(it.edge());
if (oface != UINT32_MAX && m_faceInPatch.get(oface))
m_ignoreBoundaryEdges.push_back(it.oppositeEdge());
}
}
invalid = m_boundaryGrid.intersect(m_mesh->epsilon(), m_newBoundaryEdges, m_ignoreBoundaryEdges);
XA_PROFILE_END(parameterizeChartsPiecewiseBoundaryIntersection)
}
if (invalid) {
// Mark all faces of linked candidates as invalid.
for (CandidateIterator it(bestCandidate); !it.isDone(); it.advance())
m_faceInvalid.set(it.current()->face);
removeLinkedCandidates(bestCandidate);
} else {
// Add vertex to the patch.
m_vertexInPatch.set(freeVertex);
// Add faces to the patch.
for (CandidateIterator it(bestCandidate); !it.isDone(); it.advance())
addFaceToPatch(it.current()->face);
// Successfully added candidate face(s) to patch.
removeLinkedCandidates(bestCandidate);
// Reset the grid with all edges on the patch boundary.
XA_PROFILE_START(parameterizeChartsPiecewiseBoundaryIntersection)
m_boundaryGrid.reset(m_texcoords, m_mesh->indices());
for (uint32_t i = 0; i < m_patch.size(); i++) {
for (Mesh::FaceEdgeIterator it(m_mesh, m_patch[i]); !it.isDone(); it.advance()) {
const uint32_t oface = it.oppositeFace();
if (oface == UINT32_MAX || !m_faceInPatch.get(oface))
m_boundaryGrid.append(it.edge());
}
}
XA_PROFILE_END(parameterizeChartsPiecewiseBoundaryIntersection)
}
}
return true;
}
private:
struct Candidate {
uint32_t face, vertex;
Candidate *prev, *next; // The previous/next candidate with the same vertex.
Vector2 position;
float cost;
float maxCost; // Of all linked candidates.
uint32_t patchEdge;
float patchVertexOrient;
};
struct CandidateIterator {
CandidateIterator(Candidate *head) :
m_current(head) { XA_DEBUG_ASSERT(!head->prev); }
void advance() {
if (m_current != nullptr) {
m_current = m_current->next;
}
}
bool isDone() const { return !m_current; }
Candidate *current() { return m_current; }
private:
Candidate *m_current;
};
const Mesh *m_mesh;
Array<Vector2> m_texcoords;
BitArray m_faceInAnyPatch; // Face is in a previous chart patch or the current patch.
Array<Candidate *> m_candidates; // Incident faces to the patch.
Array<Candidate *> m_faceToCandidate;
Array<uint32_t> m_patch; // The current chart patch.
BitArray m_faceInPatch, m_vertexInPatch; // Face/vertex is in the current patch.
BitArray m_faceInvalid; // Face cannot be added to the patch - flipped, cost too high or causes boundary intersection.
UniformGrid2 m_boundaryGrid;
Array<uint32_t> m_newBoundaryEdges, m_ignoreBoundaryEdges; // Temp arrays used when testing for boundary intersection.
void addFaceToPatch(uint32_t face) {
XA_DEBUG_ASSERT(!m_faceInPatch.get(face));
XA_DEBUG_ASSERT(!m_faceInAnyPatch.get(face));
m_patch.push_back(face);
m_faceInPatch.set(face);
m_faceInAnyPatch.set(face);
// Find new candidate faces on the patch incident to the newly added face.
for (Mesh::FaceEdgeIterator it(m_mesh, face); !it.isDone(); it.advance()) {
const uint32_t oface = it.oppositeFace();
if (oface == UINT32_MAX || m_faceInAnyPatch.get(oface) || m_faceToCandidate[oface])
continue;
// Found an active edge on the patch front.
// Find the free vertex (the vertex that isn't on the active edge).
// Compute the orientation of the other patch face vertex to the active edge.
uint32_t freeVertex = UINT32_MAX;
float orient = 0.0f;
for (uint32_t j = 0; j < 3; j++) {
const uint32_t vertex = m_mesh->vertexAt(oface * 3 + j);
if (vertex != it.vertex0() && vertex != it.vertex1()) {
freeVertex = vertex;
orient = orientToEdge(m_texcoords[it.vertex0()], m_texcoords[it.vertex1()], m_texcoords[m_mesh->vertexAt(face * 3 + j)]);
break;
}
}
XA_DEBUG_ASSERT(freeVertex != UINT32_MAX);
if (m_vertexInPatch.get(freeVertex)) {
#if 0
// If the free vertex is already in the patch, the face is enclosed by the patch. Add the face to the patch - don't need to assign texcoords.
freeVertex = UINT32_MAX;
addFaceToPatch(oface);
#endif
continue;
}
// Check this here rather than above so faces enclosed by the patch are always added.
if (m_faceInvalid.get(oface))
continue;
addCandidateFace(it.edge(), orient, oface, it.oppositeEdge(), freeVertex);
}
}
void addCandidateFace(uint32_t patchEdge, float patchVertexOrient, uint32_t face, uint32_t edge, uint32_t freeVertex) {
XA_DEBUG_ASSERT(!m_faceToCandidate[face]);
Vector2 texcoords[3];
orthoProjectFace(face, texcoords);
// Find corresponding vertices between the patch edge and candidate edge.
const uint32_t vertex0 = m_mesh->vertexAt(meshEdgeIndex0(patchEdge));
const uint32_t vertex1 = m_mesh->vertexAt(meshEdgeIndex1(patchEdge));
uint32_t localVertex0 = UINT32_MAX, localVertex1 = UINT32_MAX, localFreeVertex = UINT32_MAX;
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = m_mesh->vertexAt(face * 3 + i);
if (vertex == m_mesh->vertexAt(meshEdgeIndex1(edge)))
localVertex0 = i;
else if (vertex == m_mesh->vertexAt(meshEdgeIndex0(edge)))
localVertex1 = i;
else
localFreeVertex = i;
}
// Scale orthogonal projection to match the patch edge.
const Vector2 patchEdgeVec = m_texcoords[vertex1] - m_texcoords[vertex0];
const Vector2 localEdgeVec = texcoords[localVertex1] - texcoords[localVertex0];
const float len1 = length(patchEdgeVec);
const float len2 = length(localEdgeVec);
if (len1 <= 0.0f || len2 <= 0.0f)
return; // Zero length edge.
const float scale = len1 / len2;
for (uint32_t i = 0; i < 3; i++)
texcoords[i] *= scale;
// Translate to the first vertex on the patch edge.
const Vector2 translate = m_texcoords[vertex0] - texcoords[localVertex0];
for (uint32_t i = 0; i < 3; i++)
texcoords[i] += translate;
// Compute the angle between the patch edge and the corresponding local edge.
const float angle = atan2f(patchEdgeVec.y, patchEdgeVec.x) - atan2f(localEdgeVec.y, localEdgeVec.x);
// Rotate so the patch edge and the corresponding local edge occupy the same space.
for (uint32_t i = 0; i < 3; i++) {
if (i == localVertex0)
continue;
Vector2 &uv = texcoords[i];
uv -= texcoords[localVertex0]; // Rotate around the first vertex.
const float c = cosf(angle);
const float s = sinf(angle);
const float x = uv.x * c - uv.y * s;
const float y = uv.y * c + uv.x * s;
uv.x = x + texcoords[localVertex0].x;
uv.y = y + texcoords[localVertex0].y;
}
if (isNan(texcoords[localFreeVertex].x) || isNan(texcoords[localFreeVertex].y)) {
m_faceInvalid.set(face);
return;
}
// Check for local overlap (flipped triangle).
// The patch face vertex that isn't on the active edge and the free vertex should be oriented on opposite sides to the active edge.
const float freeVertexOrient = orientToEdge(m_texcoords[vertex0], m_texcoords[vertex1], texcoords[localFreeVertex]);
if ((patchVertexOrient < 0.0f && freeVertexOrient < 0.0f) || (patchVertexOrient > 0.0f && freeVertexOrient > 0.0f)) {
m_faceInvalid.set(face);
return;
}
const float stretch = computeStretch(m_mesh->position(vertex0), m_mesh->position(vertex1), m_mesh->position(freeVertex), texcoords[0], texcoords[1], texcoords[2]);
if (stretch >= FLT_MAX) {
m_faceInvalid.set(face);
return;
}
const float cost = fabsf(stretch - 1.0f);
if (cost > 0.5f) {
m_faceInvalid.set(face);
return;
}
// Add the candidate.
Candidate *candidate = XA_ALLOC(MemTag::Default, Candidate);
candidate->face = face;
candidate->vertex = freeVertex;
candidate->position = texcoords[localFreeVertex];
candidate->prev = candidate->next = nullptr;
candidate->cost = candidate->maxCost = cost;
candidate->patchEdge = patchEdge;
candidate->patchVertexOrient = patchVertexOrient;
m_candidates.push_back(candidate);
m_faceToCandidate[face] = candidate;
// Link with candidates that share the same vertex. Append to tail.
for (uint32_t i = 0; i < m_candidates.size() - 1; i++) {
if (m_candidates[i]->vertex == candidate->vertex) {
Candidate *tail = m_candidates[i];
for (;;) {
if (tail->next)
tail = tail->next;
else
break;
}
candidate->prev = tail;
candidate->next = nullptr;
tail->next = candidate;
break;
}
}
// Set max cost for linked candidates.
Candidate *head = linkedCandidateHead(candidate);
float maxCost = 0.0f;
for (CandidateIterator it(head); !it.isDone(); it.advance())
maxCost = max(maxCost, it.current()->cost);
for (CandidateIterator it(head); !it.isDone(); it.advance())
it.current()->maxCost = maxCost;
}
Candidate *linkedCandidateHead(Candidate *candidate) {
Candidate *current = candidate;
for (;;) {
if (!current->prev)
break;
current = current->prev;
}
return current;
}
void removeLinkedCandidates(Candidate *head) {
XA_DEBUG_ASSERT(!head->prev);
Candidate *current = head;
while (current) {
Candidate *next = current->next;
m_faceToCandidate[current->face] = nullptr;
for (uint32_t i = 0; i < m_candidates.size(); i++) {
if (m_candidates[i] == current) {
m_candidates.removeAt(i);
break;
}
}
XA_FREE(current);
current = next;
}
}
void orthoProjectFace(uint32_t face, Vector2 *texcoords) const {
const Vector3 normal = -m_mesh->computeFaceNormal(face);
const Vector3 tangent = normalize(m_mesh->position(m_mesh->vertexAt(face * 3 + 1)) - m_mesh->position(m_mesh->vertexAt(face * 3 + 0)));
const Vector3 bitangent = cross(normal, tangent);
for (uint32_t i = 0; i < 3; i++) {
const Vector3 &pos = m_mesh->position(m_mesh->vertexAt(face * 3 + i));
texcoords[i] = Vector2(dot(tangent, pos), dot(bitangent, pos));
}
}
float parametricArea(const Vector2 *texcoords) const {
const Vector2 &v1 = texcoords[0];
const Vector2 &v2 = texcoords[1];
const Vector2 &v3 = texcoords[2];
return ((v2.x - v1.x) * (v3.y - v1.y) - (v3.x - v1.x) * (v2.y - v1.y)) * 0.5f;
}
float computeStretch(Vector3 p1, Vector3 p2, Vector3 p3, Vector2 t1, Vector2 t2, Vector2 t3) const {
float parametricArea = ((t2.y - t1.y) * (t3.x - t1.x) - (t3.y - t1.y) * (t2.x - t1.x)) * 0.5f;
if (isZero(parametricArea, kAreaEpsilon))
return FLT_MAX;
if (parametricArea < 0.0f)
parametricArea = fabsf(parametricArea);
const float geometricArea = length(cross(p2 - p1, p3 - p1)) * 0.5f;
if (parametricArea <= geometricArea)
return parametricArea / geometricArea;
else
return geometricArea / parametricArea;
}
// Return value is positive if the point is one side of the edge, negative if on the other side.
float orientToEdge(Vector2 edgeVertex0, Vector2 edgeVertex1, Vector2 point) const {
return (edgeVertex0.x - point.x) * (edgeVertex1.y - point.y) - (edgeVertex0.y - point.y) * (edgeVertex1.x - point.x);
}
};
// Estimate quality of existing parameterization.
struct Quality {
// computeBoundaryIntersection
bool boundaryIntersection = false;
// computeFlippedFaces
uint32_t totalTriangleCount = 0;
uint32_t flippedTriangleCount = 0;
uint32_t zeroAreaTriangleCount = 0;
// computeMetrics
float totalParametricArea = 0.0f;
float totalGeometricArea = 0.0f;
float stretchMetric = 0.0f;
float maxStretchMetric = 0.0f;
float conformalMetric = 0.0f;
float authalicMetric = 0.0f;
void computeBoundaryIntersection(const Mesh *mesh, UniformGrid2 &boundaryGrid) {
const Array<uint32_t> &boundaryEdges = mesh->boundaryEdges();
const uint32_t boundaryEdgeCount = boundaryEdges.size();
boundaryGrid.reset(mesh->texcoords(), mesh->indices(), boundaryEdgeCount);
for (uint32_t i = 0; i < boundaryEdgeCount; i++)
boundaryGrid.append(boundaryEdges[i]);
boundaryIntersection = boundaryGrid.intersect(mesh->epsilon());
#if XA_DEBUG_EXPORT_BOUNDARY_GRID
static int exportIndex = 0;
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_boundary_grid_%03d.tga", exportIndex);
boundaryGrid.debugExport(filename);
exportIndex++;
#endif
}
void computeFlippedFaces(const Mesh *mesh, Array<uint32_t> *flippedFaces) {
totalTriangleCount = flippedTriangleCount = zeroAreaTriangleCount = 0;
if (flippedFaces)
flippedFaces->clear();
const uint32_t faceCount = mesh->faceCount();
for (uint32_t f = 0; f < faceCount; f++) {
Vector2 texcoord[3];
for (int i = 0; i < 3; i++) {
const uint32_t v = mesh->vertexAt(f * 3 + i);
texcoord[i] = mesh->texcoord(v);
}
totalTriangleCount++;
const float t1 = texcoord[0].x;
const float s1 = texcoord[0].y;
const float t2 = texcoord[1].x;
const float s2 = texcoord[1].y;
const float t3 = texcoord[2].x;
const float s3 = texcoord[2].y;
const float parametricArea = ((s2 - s1) * (t3 - t1) - (s3 - s1) * (t2 - t1)) * 0.5f;
if (isZero(parametricArea, kAreaEpsilon)) {
zeroAreaTriangleCount++;
continue;
}
if (parametricArea < 0.0f) {
// Count flipped triangles.
flippedTriangleCount++;
if (flippedFaces)
flippedFaces->push_back(f);
}
}
if (flippedTriangleCount + zeroAreaTriangleCount == totalTriangleCount) {
// If all triangles are flipped, then none are.
if (flippedFaces)
flippedFaces->clear();
flippedTriangleCount = 0;
}
if (flippedTriangleCount > totalTriangleCount / 2) {
// If more than half the triangles are flipped, reverse the flipped / not flipped classification.
flippedTriangleCount = totalTriangleCount - flippedTriangleCount;
if (flippedFaces) {
Array<uint32_t> temp;
flippedFaces->copyTo(temp);
flippedFaces->clear();
for (uint32_t f = 0; f < faceCount; f++) {
bool match = false;
for (uint32_t ff = 0; ff < temp.size(); ff++) {
if (temp[ff] == f) {
match = true;
break;
}
}
if (!match)
flippedFaces->push_back(f);
}
}
}
}
void computeMetrics(const Mesh *mesh) {
totalGeometricArea = totalParametricArea = 0.0f;
stretchMetric = maxStretchMetric = conformalMetric = authalicMetric = 0.0f;
const uint32_t faceCount = mesh->faceCount();
for (uint32_t f = 0; f < faceCount; f++) {
Vector3 pos[3];
Vector2 texcoord[3];
for (int i = 0; i < 3; i++) {
const uint32_t v = mesh->vertexAt(f * 3 + i);
pos[i] = mesh->position(v);
texcoord[i] = mesh->texcoord(v);
}
// Evaluate texture stretch metric. See:
// - "Texture Mapping Progressive Meshes", Sander, Snyder, Gortler & Hoppe
// - "Mesh Parameterization: Theory and Practice", Siggraph'07 Course Notes, Hormann, Levy & Sheffer.
const float t1 = texcoord[0].x;
const float s1 = texcoord[0].y;
const float t2 = texcoord[1].x;
const float s2 = texcoord[1].y;
const float t3 = texcoord[2].x;
const float s3 = texcoord[2].y;
float parametricArea = ((s2 - s1) * (t3 - t1) - (s3 - s1) * (t2 - t1)) * 0.5f;
if (isZero(parametricArea, kAreaEpsilon))
continue;
if (parametricArea < 0.0f)
parametricArea = fabsf(parametricArea);
const float geometricArea = length(cross(pos[1] - pos[0], pos[2] - pos[0])) / 2;
const Vector3 Ss = (pos[0] * (t2 - t3) + pos[1] * (t3 - t1) + pos[2] * (t1 - t2)) / (2 * parametricArea);
const Vector3 St = (pos[0] * (s3 - s2) + pos[1] * (s1 - s3) + pos[2] * (s2 - s1)) / (2 * parametricArea);
const float a = dot(Ss, Ss); // E
const float b = dot(Ss, St); // F
const float c = dot(St, St); // G
// Compute eigen-values of the first fundamental form:
const float sigma1 = sqrtf(0.5f * max(0.0f, a + c - sqrtf(square(a - c) + 4 * square(b)))); // gamma uppercase, min eigenvalue.
const float sigma2 = sqrtf(0.5f * max(0.0f, a + c + sqrtf(square(a - c) + 4 * square(b)))); // gamma lowercase, max eigenvalue.
XA_ASSERT(sigma2 > sigma1 || equal(sigma1, sigma2, kEpsilon));
// isometric: sigma1 = sigma2 = 1
// conformal: sigma1 / sigma2 = 1
// authalic: sigma1 * sigma2 = 1
const float rmsStretch = sqrtf((a + c) * 0.5f);
const float rmsStretch2 = sqrtf((square(sigma1) + square(sigma2)) * 0.5f);
XA_DEBUG_ASSERT(equal(rmsStretch, rmsStretch2, 0.01f));
XA_UNUSED(rmsStretch2);
stretchMetric += square(rmsStretch) * geometricArea;
maxStretchMetric = max(maxStretchMetric, sigma2);
if (!isZero(sigma1, 0.000001f)) {
// sigma1 is zero when geometricArea is zero.
conformalMetric += (sigma2 / sigma1) * geometricArea;
}
authalicMetric += (sigma1 * sigma2) * geometricArea;
// Accumulate total areas.
totalGeometricArea += geometricArea;
totalParametricArea += parametricArea;
}
XA_DEBUG_ASSERT(isFinite(totalParametricArea) && totalParametricArea >= 0);
XA_DEBUG_ASSERT(isFinite(totalGeometricArea) && totalGeometricArea >= 0);
XA_DEBUG_ASSERT(isFinite(stretchMetric));
XA_DEBUG_ASSERT(isFinite(maxStretchMetric));
XA_DEBUG_ASSERT(isFinite(conformalMetric));
XA_DEBUG_ASSERT(isFinite(authalicMetric));
if (totalGeometricArea > 0.0f) {
const float normFactor = sqrtf(totalParametricArea / totalGeometricArea);
stretchMetric = sqrtf(stretchMetric / totalGeometricArea) * normFactor;
maxStretchMetric *= normFactor;
conformalMetric = sqrtf(conformalMetric / totalGeometricArea);
authalicMetric = sqrtf(authalicMetric / totalGeometricArea);
}
}
};
struct ChartCtorBuffers {
Array<uint32_t> chartMeshIndices;
Array<uint32_t> unifiedMeshIndices;
};
class Chart {
public:
Chart(const Basis &basis, segment::ChartGeneratorType::Enum generatorType, ConstArrayView<uint32_t> faces, const Mesh *sourceMesh, uint32_t chartGroupId, uint32_t chartId) :
m_basis(basis), m_unifiedMesh(nullptr), m_type(ChartType::LSCM), m_generatorType(generatorType), m_tjunctionCount(0), m_originalVertexCount(0), m_isInvalid(false) {
XA_UNUSED(chartGroupId);
XA_UNUSED(chartId);
m_faceToSourceFaceMap.copyFrom(faces.data, faces.length);
const uint32_t approxVertexCount = min(faces.length * 3, sourceMesh->vertexCount());
m_unifiedMesh = XA_NEW_ARGS(MemTag::Mesh, Mesh, sourceMesh->epsilon(), approxVertexCount, faces.length);
HashMap<uint32_t, PassthroughHash<uint32_t>> sourceVertexToUnifiedVertexMap(MemTag::Mesh, approxVertexCount), sourceVertexToChartVertexMap(MemTag::Mesh, approxVertexCount);
m_originalIndices.resize(faces.length * 3);
// Add geometry.
const uint32_t faceCount = faces.length;
for (uint32_t f = 0; f < faceCount; f++) {
uint32_t unifiedIndices[3];
for (uint32_t i = 0; i < 3; i++) {
const uint32_t sourceVertex = sourceMesh->vertexAt(m_faceToSourceFaceMap[f] * 3 + i);
uint32_t sourceUnifiedVertex = sourceVertex;
uint32_t unifiedVertex = sourceVertexToUnifiedVertexMap.get(sourceUnifiedVertex);
if (unifiedVertex == UINT32_MAX) {
unifiedVertex = sourceVertexToUnifiedVertexMap.add(sourceUnifiedVertex);
m_unifiedMesh->addVertex(sourceMesh->position(sourceVertex), Vector3(0.0f), sourceMesh->texcoord(sourceVertex));
}
if (sourceVertexToChartVertexMap.get(sourceVertex) == UINT32_MAX) {
sourceVertexToChartVertexMap.add(sourceVertex);
m_vertexToSourceVertexMap.push_back(sourceVertex);
m_chartVertexToUnifiedVertexMap.push_back(unifiedVertex);
m_originalVertexCount++;
}
m_originalIndices[f * 3 + i] = sourceVertexToChartVertexMap.get(sourceVertex);
;
XA_DEBUG_ASSERT(m_originalIndices[f * 3 + i] != UINT32_MAX);
unifiedIndices[i] = sourceVertexToUnifiedVertexMap.get(sourceUnifiedVertex);
XA_DEBUG_ASSERT(unifiedIndices[i] != UINT32_MAX);
}
m_unifiedMesh->addFace(unifiedIndices);
}
m_unifiedMesh->createBoundaries();
#if XA_CHECK_T_JUNCTIONS
m_tjunctionCount = meshCheckTJunctions(*m_unifiedMesh);
#if XA_DEBUG_EXPORT_OBJ_TJUNCTION
if (m_tjunctionCount > 0) {
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_mesh_%03u_chartgroup_%03u_chart_%03u_tjunction.obj", sourceMesh->id(), chartGroupId, chartId);
m_unifiedMesh->writeObjFile(filename);
}
#endif
#endif
}
Chart(ChartCtorBuffers &buffers, const Chart *parent, const Mesh *parentMesh, ConstArrayView<uint32_t> faces, ConstArrayView<Vector2> texcoords, const Mesh *sourceMesh) :
m_unifiedMesh(nullptr), m_type(ChartType::Piecewise), m_generatorType(segment::ChartGeneratorType::Piecewise), m_tjunctionCount(0), m_originalVertexCount(0), m_isInvalid(false) {
const uint32_t faceCount = faces.length;
m_faceToSourceFaceMap.resize(faceCount);
for (uint32_t i = 0; i < faceCount; i++)
m_faceToSourceFaceMap[i] = parent->m_faceToSourceFaceMap[faces[i]]; // Map faces to parent chart source mesh.
// Copy face indices.
Array<uint32_t> &chartMeshIndices = buffers.chartMeshIndices;
chartMeshIndices.resize(sourceMesh->vertexCount());
chartMeshIndices.fillBytes(0xff);
m_unifiedMesh = XA_NEW_ARGS(MemTag::Mesh, Mesh, sourceMesh->epsilon(), m_faceToSourceFaceMap.size() * 3, m_faceToSourceFaceMap.size());
HashMap<uint32_t, PassthroughHash<uint32_t>> sourceVertexToUnifiedVertexMap(MemTag::Mesh, m_faceToSourceFaceMap.size() * 3);
// Add vertices.
for (uint32_t f = 0; f < faceCount; f++) {
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = sourceMesh->vertexAt(m_faceToSourceFaceMap[f] * 3 + i);
const uint32_t sourceUnifiedVertex = vertex;
const uint32_t parentVertex = parentMesh->vertexAt(faces[f] * 3 + i);
uint32_t unifiedVertex = sourceVertexToUnifiedVertexMap.get(sourceUnifiedVertex);
if (unifiedVertex == UINT32_MAX) {
unifiedVertex = sourceVertexToUnifiedVertexMap.add(sourceUnifiedVertex);
m_unifiedMesh->addVertex(sourceMesh->position(vertex), Vector3(0.0f), texcoords[parentVertex]);
}
if (chartMeshIndices[vertex] == UINT32_MAX) {
chartMeshIndices[vertex] = m_originalVertexCount;
m_originalVertexCount++;
m_vertexToSourceVertexMap.push_back(vertex);
m_chartVertexToUnifiedVertexMap.push_back(unifiedVertex);
}
}
}
// Add faces.
m_originalIndices.resize(faceCount * 3);
for (uint32_t f = 0; f < faceCount; f++) {
uint32_t unifiedIndices[3];
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = sourceMesh->vertexAt(m_faceToSourceFaceMap[f] * 3 + i);
m_originalIndices[f * 3 + i] = chartMeshIndices[vertex];
//const uint32_t unifiedVertex = sourceMesh->firstColocalVertex(vertex);
const uint32_t unifiedVertex = vertex;
unifiedIndices[i] = sourceVertexToUnifiedVertexMap.get(unifiedVertex);
}
m_unifiedMesh->addFace(unifiedIndices);
}
m_unifiedMesh->createBoundaries();
// Need to store texcoords for backup/restore so packing can be run multiple times.
backupTexcoords();
}
~Chart() {
if (m_unifiedMesh) {
m_unifiedMesh->~Mesh();
XA_FREE(m_unifiedMesh);
m_unifiedMesh = nullptr;
}
}
bool isInvalid() const { return m_isInvalid; }
ChartType type() const { return m_type; }
segment::ChartGeneratorType::Enum generatorType() const { return m_generatorType; }
uint32_t tjunctionCount() const { return m_tjunctionCount; }
const Quality &quality() const { return m_quality; }
#if XA_DEBUG_EXPORT_OBJ_INVALID_PARAMETERIZATION
const Array<uint32_t> &paramFlippedFaces() const { return m_paramFlippedFaces; }
#endif
uint32_t mapFaceToSourceFace(uint32_t i) const { return m_faceToSourceFaceMap[i]; }
uint32_t mapChartVertexToSourceVertex(uint32_t i) const { return m_vertexToSourceVertexMap[i]; }
const Mesh *unifiedMesh() const { return m_unifiedMesh; }
Mesh *unifiedMesh() { return m_unifiedMesh; }
// Vertex count of the chart mesh before unifying vertices.
uint32_t originalVertexCount() const { return m_originalVertexCount; }
uint32_t originalVertexToUnifiedVertex(uint32_t v) const { return m_chartVertexToUnifiedVertexMap[v]; }
ConstArrayView<uint32_t> originalVertices() const { return m_originalIndices; }
void parameterize(const ChartOptions &options, UniformGrid2 &boundaryGrid) {
const uint32_t unifiedVertexCount = m_unifiedMesh->vertexCount();
if (m_generatorType == segment::ChartGeneratorType::OriginalUv) {
} else {
// Project vertices to plane.
XA_PROFILE_START(parameterizeChartsOrthogonal)
for (uint32_t i = 0; i < unifiedVertexCount; i++)
m_unifiedMesh->texcoord(i) = Vector2(dot(m_basis.tangent, m_unifiedMesh->position(i)), dot(m_basis.bitangent, m_unifiedMesh->position(i)));
XA_PROFILE_END(parameterizeChartsOrthogonal)
// Computing charts checks for flipped triangles and boundary intersection. Don't need to do that again here if chart is planar.
if (m_generatorType != segment::ChartGeneratorType::OriginalUv) {
XA_PROFILE_START(parameterizeChartsEvaluateQuality)
m_quality.computeBoundaryIntersection(m_unifiedMesh, boundaryGrid);
m_quality.computeFlippedFaces(m_unifiedMesh, nullptr);
m_quality.computeMetrics(m_unifiedMesh);
XA_PROFILE_END(parameterizeChartsEvaluateQuality)
// Use orthogonal parameterization if quality is acceptable.
if (!m_quality.boundaryIntersection && m_quality.flippedTriangleCount == 0 && m_quality.zeroAreaTriangleCount == 0 && m_quality.totalGeometricArea > 0.0f && m_quality.stretchMetric <= 1.1f && m_quality.maxStretchMetric <= 1.25f)
m_type = ChartType::Ortho;
}
if (m_type == ChartType::LSCM) {
XA_PROFILE_START(parameterizeChartsLSCM)
if (options.paramFunc) {
options.paramFunc(&m_unifiedMesh->position(0).x, &m_unifiedMesh->texcoord(0).x, m_unifiedMesh->vertexCount(), m_unifiedMesh->indices().data, m_unifiedMesh->indexCount());
} else
computeLeastSquaresConformalMap(m_unifiedMesh);
XA_PROFILE_END(parameterizeChartsLSCM)
XA_PROFILE_START(parameterizeChartsEvaluateQuality)
m_quality.computeBoundaryIntersection(m_unifiedMesh, boundaryGrid);
#if XA_DEBUG_EXPORT_OBJ_INVALID_PARAMETERIZATION
m_quality.computeFlippedFaces(m_unifiedMesh, &m_paramFlippedFaces);
#else
m_quality.computeFlippedFaces(m_unifiedMesh, nullptr);
#endif
// Don't need to call computeMetrics here, that's only used in evaluateOrthoQuality to determine if quality is acceptable enough to use ortho projection.
if (m_quality.boundaryIntersection || m_quality.flippedTriangleCount > 0 || m_quality.zeroAreaTriangleCount > 0)
m_isInvalid = true;
XA_PROFILE_END(parameterizeChartsEvaluateQuality)
}
}
if (options.fixWinding && m_unifiedMesh->computeFaceParametricArea(0) < 0.0f) {
for (uint32_t i = 0; i < unifiedVertexCount; i++)
m_unifiedMesh->texcoord(i).x *= -1.0f;
}
#if XA_CHECK_PARAM_WINDING
const uint32_t faceCount = m_unifiedMesh->faceCount();
uint32_t flippedCount = 0;
for (uint32_t i = 0; i < faceCount; i++) {
const float area = m_unifiedMesh->computeFaceParametricArea(i);
if (area < 0.0f)
flippedCount++;
}
if (flippedCount == faceCount) {
XA_PRINT_WARNING("param: all faces flipped\n");
} else if (flippedCount > 0) {
XA_PRINT_WARNING("param: %u / %u faces flipped\n", flippedCount, faceCount);
}
#endif
#if XA_DEBUG_ALL_CHARTS_INVALID
m_isInvalid = true;
#endif
// Need to store texcoords for backup/restore so packing can be run multiple times.
backupTexcoords();
}
Vector2 computeParametricBounds() const {
Vector2 minCorner(FLT_MAX, FLT_MAX);
Vector2 maxCorner(-FLT_MAX, -FLT_MAX);
const uint32_t vertexCount = m_unifiedMesh->vertexCount();
for (uint32_t v = 0; v < vertexCount; v++) {
minCorner = min(minCorner, m_unifiedMesh->texcoord(v));
maxCorner = max(maxCorner, m_unifiedMesh->texcoord(v));
}
return (maxCorner - minCorner) * 0.5f;
}
#if XA_CHECK_PIECEWISE_CHART_QUALITY
void evaluateQuality(UniformGrid2 &boundaryGrid) {
m_quality.computeBoundaryIntersection(m_unifiedMesh, boundaryGrid);
#if XA_DEBUG_EXPORT_OBJ_INVALID_PARAMETERIZATION
m_quality.computeFlippedFaces(m_unifiedMesh, &m_paramFlippedFaces);
#else
m_quality.computeFlippedFaces(m_unifiedMesh, nullptr);
#endif
if (m_quality.boundaryIntersection || m_quality.flippedTriangleCount > 0 || m_quality.zeroAreaTriangleCount > 0)
m_isInvalid = true;
}
#endif
void restoreTexcoords() {
memcpy(m_unifiedMesh->texcoords().data, m_backupTexcoords.data(), m_unifiedMesh->vertexCount() * sizeof(Vector2));
}
private:
void backupTexcoords() {
m_backupTexcoords.resize(m_unifiedMesh->vertexCount());
memcpy(m_backupTexcoords.data(), m_unifiedMesh->texcoords().data, m_unifiedMesh->vertexCount() * sizeof(Vector2));
}
Basis m_basis;
Mesh *m_unifiedMesh;
ChartType m_type;
segment::ChartGeneratorType::Enum m_generatorType;
uint32_t m_tjunctionCount;
uint32_t m_originalVertexCount;
Array<uint32_t> m_originalIndices;
// List of faces of the source mesh that belong to this chart.
Array<uint32_t> m_faceToSourceFaceMap;
// Map vertices of the chart mesh to vertices of the source mesh.
Array<uint32_t> m_vertexToSourceVertexMap;
Array<uint32_t> m_chartVertexToUnifiedVertexMap;
Array<Vector2> m_backupTexcoords;
Quality m_quality;
#if XA_DEBUG_EXPORT_OBJ_INVALID_PARAMETERIZATION
Array<uint32_t> m_paramFlippedFaces;
#endif
bool m_isInvalid;
};
struct CreateAndParameterizeChartTaskGroupArgs {
Progress *progress;
ThreadLocal<UniformGrid2> *boundaryGrid;
ThreadLocal<ChartCtorBuffers> *chartBuffers;
const ChartOptions *options;
ThreadLocal<PiecewiseParam> *pp;
};
struct CreateAndParameterizeChartTaskArgs {
const Basis *basis;
Chart *chart; // output
Array<Chart *> charts; // output (if more than one chart)
segment::ChartGeneratorType::Enum chartGeneratorType;
const Mesh *mesh;
ConstArrayView<uint32_t> faces;
uint32_t chartGroupId;
uint32_t chartId;
};
static void runCreateAndParameterizeChartTask(void *groupUserData, void *taskUserData) {
XA_PROFILE_START(createChartMeshAndParameterizeThread)
auto groupArgs = (CreateAndParameterizeChartTaskGroupArgs *)groupUserData;
auto args = (CreateAndParameterizeChartTaskArgs *)taskUserData;
XA_PROFILE_START(createChartMesh)
args->chart = XA_NEW_ARGS(MemTag::Default, Chart, *args->basis, args->chartGeneratorType, args->faces, args->mesh, args->chartGroupId, args->chartId);
XA_PROFILE_END(createChartMesh)
XA_PROFILE_START(parameterizeCharts)
args->chart->parameterize(*groupArgs->options, groupArgs->boundaryGrid->get());
XA_PROFILE_END(parameterizeCharts)
#if XA_RECOMPUTE_CHARTS
if (!args->chart->isInvalid()) {
XA_PROFILE_END(createChartMeshAndParameterizeThread)
return;
}
// Recompute charts with invalid parameterizations.
XA_PROFILE_START(parameterizeChartsRecompute)
Chart *invalidChart = args->chart;
const Mesh *invalidMesh = invalidChart->unifiedMesh();
PiecewiseParam &pp = groupArgs->pp->get();
pp.reset(invalidMesh);
#if XA_DEBUG_EXPORT_OBJ_RECOMPUTED_CHARTS
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_mesh_%03u_chartgroup_%03u_chart_%03u_recomputed.obj", args->mesh->id(), args->chartGroupId, args->chartId);
FILE *file;
XA_FOPEN(file, filename, "w");
uint32_t subChartIndex = 0;
#endif
for (;;) {
XA_PROFILE_START(parameterizeChartsPiecewise)
const bool facesRemaining = pp.computeChart();
XA_PROFILE_END(parameterizeChartsPiecewise)
if (!facesRemaining)
break;
Chart *chart = XA_NEW_ARGS(MemTag::Default, Chart, groupArgs->chartBuffers->get(), invalidChart, invalidMesh, pp.chartFaces(), pp.texcoords(), args->mesh);
#if XA_CHECK_PIECEWISE_CHART_QUALITY
chart->evaluateQuality(args->boundaryGrid->get());
#endif
args->charts.push_back(chart);
#if XA_DEBUG_EXPORT_OBJ_RECOMPUTED_CHARTS
if (file) {
for (uint32_t j = 0; j < invalidMesh->vertexCount(); j++) {
fprintf(file, "v %g %g %g\n", invalidMesh->position(j).x, invalidMesh->position(j).y, invalidMesh->position(j).z);
fprintf(file, "vt %g %g\n", pp.texcoords()[j].x, pp.texcoords()[j].y);
}
fprintf(file, "o chart%03u\n", subChartIndex);
fprintf(file, "s off\n");
for (uint32_t f = 0; f < pp.chartFaces().length; f++) {
fprintf(file, "f ");
const uint32_t face = pp.chartFaces()[f];
for (uint32_t j = 0; j < 3; j++) {
const uint32_t index = invalidMesh->vertexCount() * subChartIndex + invalidMesh->vertexAt(face * 3 + j) + 1; // 1-indexed
fprintf(file, "%d/%d/%c", index, index, j == 2 ? '\n' : ' ');
}
}
}
subChartIndex++;
#endif
}
#if XA_DEBUG_EXPORT_OBJ_RECOMPUTED_CHARTS
if (file)
fclose(file);
#endif
XA_PROFILE_END(parameterizeChartsRecompute)
#endif // XA_RECOMPUTE_CHARTS
XA_PROFILE_END(createChartMeshAndParameterizeThread)
// Update progress.
groupArgs->progress->increment(args->faces.length);
}
// Set of charts corresponding to mesh faces in the same face group.
class ChartGroup {
public:
ChartGroup(uint32_t id, const Mesh *sourceMesh, const MeshFaceGroups *sourceMeshFaceGroups, MeshFaceGroups::Handle faceGroup) :
m_id(id), m_sourceMesh(sourceMesh), m_sourceMeshFaceGroups(sourceMeshFaceGroups), m_faceGroup(faceGroup) {
}
~ChartGroup() {
for (uint32_t i = 0; i < m_charts.size(); i++) {
m_charts[i]->~Chart();
XA_FREE(m_charts[i]);
}
}
uint32_t chartCount() const { return m_charts.size(); }
Chart *chartAt(uint32_t i) const { return m_charts[i]; }
uint32_t faceCount() const { return m_sourceMeshFaceGroups->faceCount(m_faceGroup); }
void computeCharts(TaskScheduler *taskScheduler, const ChartOptions &options, Progress *progress, segment::Atlas &atlas, ThreadLocal<UniformGrid2> *boundaryGrid, ThreadLocal<ChartCtorBuffers> *chartBuffers, ThreadLocal<PiecewiseParam> *piecewiseParam) {
// This function may be called multiple times, so destroy existing charts.
for (uint32_t i = 0; i < m_charts.size(); i++) {
m_charts[i]->~Chart();
XA_FREE(m_charts[i]);
}
// Create mesh from source mesh, using only the faces in this face group.
XA_PROFILE_START(createChartGroupMesh)
Mesh *mesh = createMesh();
XA_PROFILE_END(createChartGroupMesh)
// Segment mesh into charts (arrays of faces).
#if XA_DEBUG_SINGLE_CHART
XA_UNUSED(options);
XA_UNUSED(atlas);
const uint32_t chartCount = 1;
uint32_t offset;
Basis chartBasis;
Fit::computeBasis(&mesh->position(0), mesh->vertexCount(), &chartBasis);
Array<uint32_t> chartFaces;
chartFaces.resize(1 + mesh->faceCount());
chartFaces[0] = mesh->faceCount();
for (uint32_t i = 0; i < chartFaces.size() - 1; i++)
chartFaces[i + 1] = m_faceToSourceFaceMap[i];
// Destroy mesh.
const uint32_t faceCount = mesh->faceCount();
mesh->~Mesh();
XA_FREE(mesh);
#else
XA_PROFILE_START(buildAtlas)
atlas.reset(mesh, options);
atlas.compute();
XA_PROFILE_END(buildAtlas)
// Update progress.
progress->increment(faceCount());
#if XA_DEBUG_EXPORT_OBJ_CHARTS
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_mesh_%03u_chartgroup_%03u_charts.obj", m_sourceMesh->id(), m_id);
FILE *file;
XA_FOPEN(file, filename, "w");
if (file) {
mesh->writeObjVertices(file);
for (uint32_t i = 0; i < atlas.chartCount(); i++) {
fprintf(file, "o chart_%04d\n", i);
fprintf(file, "s off\n");
ConstArrayView<uint32_t> faces = atlas.chartFaces(i);
for (uint32_t f = 0; f < faces.length; f++)
mesh->writeObjFace(file, faces[f]);
}
mesh->writeObjBoundaryEges(file);
fclose(file);
}
#endif
// Destroy mesh.
const uint32_t faceCount = mesh->faceCount();
mesh->~Mesh();
XA_FREE(mesh);
XA_PROFILE_START(copyChartFaces)
if (progress->cancel)
return;
// Copy faces from segment::Atlas to m_chartFaces array with <chart 0 face count> <face 0> <face n> <chart 1 face count> etc. encoding.
// segment::Atlas faces refer to the chart group mesh. Map them to the input mesh instead.
const uint32_t chartCount = atlas.chartCount();
Array<uint32_t> chartFaces;
chartFaces.resize(chartCount + faceCount);
uint32_t offset = 0;
for (uint32_t i = 0; i < chartCount; i++) {
ConstArrayView<uint32_t> faces = atlas.chartFaces(i);
chartFaces[offset++] = faces.length;
for (uint32_t j = 0; j < faces.length; j++)
chartFaces[offset++] = m_faceToSourceFaceMap[faces[j]];
}
XA_PROFILE_END(copyChartFaces)
#endif
XA_PROFILE_START(createChartMeshAndParameterizeReal)
CreateAndParameterizeChartTaskGroupArgs groupArgs;
groupArgs.progress = progress;
groupArgs.boundaryGrid = boundaryGrid;
groupArgs.chartBuffers = chartBuffers;
groupArgs.options = &options;
groupArgs.pp = piecewiseParam;
TaskGroupHandle taskGroup = taskScheduler->createTaskGroup(&groupArgs, chartCount);
Array<CreateAndParameterizeChartTaskArgs> taskArgs;
taskArgs.resize(chartCount);
taskArgs.runCtors(); // Has Array member.
offset = 0;
for (uint32_t i = 0; i < chartCount; i++) {
CreateAndParameterizeChartTaskArgs &args = taskArgs[i];
#if XA_DEBUG_SINGLE_CHART
args.basis = &chartBasis;
args.isPlanar = false;
#else
args.basis = &atlas.chartBasis(i);
args.chartGeneratorType = atlas.chartGeneratorType(i);
#endif
args.chart = nullptr;
args.chartGroupId = m_id;
args.chartId = i;
const uint32_t chartFaceCount = chartFaces[offset++];
args.faces = ConstArrayView<uint32_t>(&chartFaces[offset], chartFaceCount);
offset += chartFaceCount;
args.mesh = m_sourceMesh;
Task task;
task.userData = &args;
task.func = runCreateAndParameterizeChartTask;
taskScheduler->run(taskGroup, task);
}
taskScheduler->wait(&taskGroup);
XA_PROFILE_END(createChartMeshAndParameterizeReal)
#if XA_RECOMPUTE_CHARTS
// Count charts. Skip invalid ones and include new ones added by recomputing.
uint32_t newChartCount = 0;
for (uint32_t i = 0; i < chartCount; i++) {
if (taskArgs[i].chart->isInvalid())
newChartCount += taskArgs[i].charts.size();
else
newChartCount++;
}
m_charts.resize(newChartCount);
// Add valid charts first. Destroy invalid ones.
uint32_t current = 0;
for (uint32_t i = 0; i < chartCount; i++) {
Chart *chart = taskArgs[i].chart;
if (chart->isInvalid()) {
chart->~Chart();
XA_FREE(chart);
continue;
}
m_charts[current++] = chart;
}
// Now add new charts.
for (uint32_t i = 0; i < chartCount; i++) {
CreateAndParameterizeChartTaskArgs &args = taskArgs[i];
for (uint32_t j = 0; j < args.charts.size(); j++)
m_charts[current++] = args.charts[j];
}
#else // XA_RECOMPUTE_CHARTS
m_charts.resize(chartCount);
for (uint32_t i = 0; i < chartCount; i++)
m_charts[i] = taskArgs[i].chart;
#endif // XA_RECOMPUTE_CHARTS
taskArgs.runDtors(); // Has Array member.
}
private:
Mesh *createMesh() {
XA_DEBUG_ASSERT(m_faceGroup != MeshFaceGroups::kInvalid);
// Create new mesh from the source mesh, using faces that belong to this group.
m_faceToSourceFaceMap.reserve(m_sourceMeshFaceGroups->faceCount(m_faceGroup));
for (MeshFaceGroups::Iterator it(m_sourceMeshFaceGroups, m_faceGroup); !it.isDone(); it.advance())
m_faceToSourceFaceMap.push_back(it.face());
// Only initial meshes has ignored faces. The only flag we care about is HasNormals.
const uint32_t faceCount = m_faceToSourceFaceMap.size();
XA_DEBUG_ASSERT(faceCount > 0);
const uint32_t approxVertexCount = min(faceCount * 3, m_sourceMesh->vertexCount());
Mesh *mesh = XA_NEW_ARGS(MemTag::Mesh, Mesh, m_sourceMesh->epsilon(), approxVertexCount, faceCount, m_sourceMesh->flags() & MeshFlags::HasNormals);
HashMap<uint32_t, PassthroughHash<uint32_t>> sourceVertexToVertexMap(MemTag::Mesh, approxVertexCount);
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t face = m_faceToSourceFaceMap[f];
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = m_sourceMesh->vertexAt(face * 3 + i);
if (sourceVertexToVertexMap.get(vertex) == UINT32_MAX) {
sourceVertexToVertexMap.add(vertex);
Vector3 normal(0.0f);
if (m_sourceMesh->flags() & MeshFlags::HasNormals)
normal = m_sourceMesh->normal(vertex);
mesh->addVertex(m_sourceMesh->position(vertex), normal, m_sourceMesh->texcoord(vertex));
}
}
}
// Add faces.
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t face = m_faceToSourceFaceMap[f];
XA_DEBUG_ASSERT(!m_sourceMesh->isFaceIgnored(face));
uint32_t indices[3];
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = m_sourceMesh->vertexAt(face * 3 + i);
indices[i] = sourceVertexToVertexMap.get(vertex);
XA_DEBUG_ASSERT(indices[i] != UINT32_MAX);
}
// Don't copy flags - ignored faces aren't used by chart groups, they are handled by InvalidMeshGeometry.
mesh->addFace(indices);
}
XA_PROFILE_START(createChartGroupMeshBoundaries)
mesh->createBoundaries();
mesh->destroyEdgeMap(); // Only needed it for createBoundaries.
XA_PROFILE_END(createChartGroupMeshBoundaries)
#if XA_DEBUG_EXPORT_OBJ_CHART_GROUPS
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_mesh_%03u_chartgroup_%03u.obj", m_sourceMesh->id(), m_id);
mesh->writeObjFile(filename);
#endif
return mesh;
}
const uint32_t m_id;
const Mesh *const m_sourceMesh;
const MeshFaceGroups *const m_sourceMeshFaceGroups;
const MeshFaceGroups::Handle m_faceGroup;
Array<uint32_t> m_faceToSourceFaceMap; // List of faces of the source mesh that belong to this chart group.
Array<Chart *> m_charts;
};
struct ChartGroupComputeChartsTaskGroupArgs {
ThreadLocal<segment::Atlas> *atlas;
const ChartOptions *options;
Progress *progress;
TaskScheduler *taskScheduler;
ThreadLocal<UniformGrid2> *boundaryGrid;
ThreadLocal<ChartCtorBuffers> *chartBuffers;
ThreadLocal<PiecewiseParam> *piecewiseParam;
};
static void runChartGroupComputeChartsTask(void *groupUserData, void *taskUserData) {
auto args = (ChartGroupComputeChartsTaskGroupArgs *)groupUserData;
auto chartGroup = (ChartGroup *)taskUserData;
if (args->progress->cancel)
return;
XA_PROFILE_START(chartGroupComputeChartsThread)
chartGroup->computeCharts(args->taskScheduler, *args->options, args->progress, args->atlas->get(), args->boundaryGrid, args->chartBuffers, args->piecewiseParam);
XA_PROFILE_END(chartGroupComputeChartsThread)
}
struct MeshComputeChartsTaskGroupArgs {
ThreadLocal<segment::Atlas> *atlas;
const ChartOptions *options;
Progress *progress;
TaskScheduler *taskScheduler;
ThreadLocal<UniformGrid2> *boundaryGrid;
ThreadLocal<ChartCtorBuffers> *chartBuffers;
ThreadLocal<PiecewiseParam> *piecewiseParam;
};
struct MeshComputeChartsTaskArgs {
const Mesh *sourceMesh;
Array<ChartGroup *> *chartGroups; // output
InvalidMeshGeometry *invalidMeshGeometry; // output
};
#if XA_DEBUG_EXPORT_OBJ_FACE_GROUPS
static uint32_t s_faceGroupsCurrentVertex = 0;
#endif
static void runMeshComputeChartsTask(void *groupUserData, void *taskUserData) {
auto groupArgs = (MeshComputeChartsTaskGroupArgs *)groupUserData;
auto args = (MeshComputeChartsTaskArgs *)taskUserData;
if (groupArgs->progress->cancel)
return;
XA_PROFILE_START(computeChartsThread)
// Create face groups.
XA_PROFILE_START(createFaceGroups)
MeshFaceGroups *meshFaceGroups = XA_NEW_ARGS(MemTag::Mesh, MeshFaceGroups, args->sourceMesh);
meshFaceGroups->compute();
const uint32_t chartGroupCount = meshFaceGroups->groupCount();
XA_PROFILE_END(createFaceGroups)
if (groupArgs->progress->cancel)
goto cleanup;
#if XA_DEBUG_EXPORT_OBJ_FACE_GROUPS
{
static std::mutex s_mutex;
std::lock_guard<std::mutex> lock(s_mutex);
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_face_groups.obj");
FILE *file;
XA_FOPEN(file, filename, s_faceGroupsCurrentVertex == 0 ? "w" : "a");
if (file) {
const Mesh *mesh = args->sourceMesh;
mesh->writeObjVertices(file);
// groups
uint32_t numGroups = 0;
for (uint32_t i = 0; i < mesh->faceCount(); i++) {
if (meshFaceGroups->groupAt(i) != MeshFaceGroups::kInvalid)
numGroups = max(numGroups, meshFaceGroups->groupAt(i) + 1);
}
for (uint32_t i = 0; i < numGroups; i++) {
fprintf(file, "o mesh_%03u_group_%04d\n", mesh->id(), i);
fprintf(file, "s off\n");
for (uint32_t f = 0; f < mesh->faceCount(); f++) {
if (meshFaceGroups->groupAt(f) == i)
mesh->writeObjFace(file, f, s_faceGroupsCurrentVertex);
}
}
fprintf(file, "o mesh_%03u_group_ignored\n", mesh->id());
fprintf(file, "s off\n");
for (uint32_t f = 0; f < mesh->faceCount(); f++) {
if (meshFaceGroups->groupAt(f) == MeshFaceGroups::kInvalid)
mesh->writeObjFace(file, f, s_faceGroupsCurrentVertex);
}
mesh->writeObjBoundaryEges(file);
s_faceGroupsCurrentVertex += mesh->vertexCount();
fclose(file);
}
}
#endif
// Create a chart group for each face group.
args->chartGroups->resize(chartGroupCount);
for (uint32_t i = 0; i < chartGroupCount; i++)
(*args->chartGroups)[i] = XA_NEW_ARGS(MemTag::Default, ChartGroup, i, args->sourceMesh, meshFaceGroups, MeshFaceGroups::Handle(i));
// Extract invalid geometry via the invalid face group (MeshFaceGroups::kInvalid).
{
XA_PROFILE_START(extractInvalidMeshGeometry)
args->invalidMeshGeometry->extract(args->sourceMesh, meshFaceGroups);
XA_PROFILE_END(extractInvalidMeshGeometry)
}
// One task for each chart group - compute charts.
{
XA_PROFILE_START(chartGroupComputeChartsReal)
// Sort chart groups by face count.
Array<float> chartGroupSortData;
chartGroupSortData.resize(chartGroupCount);
for (uint32_t i = 0; i < chartGroupCount; i++)
chartGroupSortData[i] = (float)(*args->chartGroups)[i]->faceCount();
RadixSort chartGroupSort;
chartGroupSort.sort(chartGroupSortData);
// Larger chart groups are added first to reduce the chance of thread starvation.
ChartGroupComputeChartsTaskGroupArgs taskGroupArgs;
taskGroupArgs.atlas = groupArgs->atlas;
taskGroupArgs.options = groupArgs->options;
taskGroupArgs.progress = groupArgs->progress;
taskGroupArgs.taskScheduler = groupArgs->taskScheduler;
taskGroupArgs.boundaryGrid = groupArgs->boundaryGrid;
taskGroupArgs.chartBuffers = groupArgs->chartBuffers;
taskGroupArgs.piecewiseParam = groupArgs->piecewiseParam;
TaskGroupHandle taskGroup = groupArgs->taskScheduler->createTaskGroup(&taskGroupArgs, chartGroupCount);
for (uint32_t i = 0; i < chartGroupCount; i++) {
Task task;
task.userData = (*args->chartGroups)[chartGroupCount - i - 1];
task.func = runChartGroupComputeChartsTask;
groupArgs->taskScheduler->run(taskGroup, task);
}
groupArgs->taskScheduler->wait(&taskGroup);
XA_PROFILE_END(chartGroupComputeChartsReal)
}
XA_PROFILE_END(computeChartsThread)
cleanup:
if (meshFaceGroups) {
meshFaceGroups->~MeshFaceGroups();
XA_FREE(meshFaceGroups);
}
}
/// An atlas is a set of chart groups.
class Atlas {
public:
Atlas() :
m_chartsComputed(false) {}
~Atlas() {
for (uint32_t i = 0; i < m_meshChartGroups.size(); i++) {
for (uint32_t j = 0; j < m_meshChartGroups[i].size(); j++) {
m_meshChartGroups[i][j]->~ChartGroup();
XA_FREE(m_meshChartGroups[i][j]);
}
}
m_meshChartGroups.runDtors();
m_invalidMeshGeometry.runDtors();
}
uint32_t meshCount() const { return m_meshes.size(); }
const InvalidMeshGeometry &invalidMeshGeometry(uint32_t meshIndex) const { return m_invalidMeshGeometry[meshIndex]; }
bool chartsComputed() const { return m_chartsComputed; }
uint32_t chartGroupCount(uint32_t mesh) const { return m_meshChartGroups[mesh].size(); }
const ChartGroup *chartGroupAt(uint32_t mesh, uint32_t group) const { return m_meshChartGroups[mesh][group]; }
void addMesh(const Mesh *mesh) {
m_meshes.push_back(mesh);
}
bool computeCharts(TaskScheduler *taskScheduler, const ChartOptions &options, ProgressFunc progressFunc, void *progressUserData) {
XA_PROFILE_START(computeChartsReal)
#if XA_DEBUG_EXPORT_OBJ_PLANAR_REGIONS
segment::s_planarRegionsCurrentRegion = segment::s_planarRegionsCurrentVertex = 0;
#endif
// Progress is per-face x 2 (1 for chart faces, 1 for parameterized chart faces).
const uint32_t meshCount = m_meshes.size();
uint32_t totalFaceCount = 0;
for (uint32_t i = 0; i < meshCount; i++)
totalFaceCount += m_meshes[i]->faceCount();
Progress progress(ProgressCategory::ComputeCharts, progressFunc, progressUserData, totalFaceCount * 2);
m_chartsComputed = false;
// Clear chart groups, since this function may be called multiple times.
if (!m_meshChartGroups.isEmpty()) {
for (uint32_t i = 0; i < m_meshChartGroups.size(); i++) {
for (uint32_t j = 0; j < m_meshChartGroups[i].size(); j++) {
m_meshChartGroups[i][j]->~ChartGroup();
XA_FREE(m_meshChartGroups[i][j]);
}
m_meshChartGroups[i].clear();
}
XA_ASSERT(m_meshChartGroups.size() == meshCount); // The number of meshes shouldn't have changed.
}
m_meshChartGroups.resize(meshCount);
m_meshChartGroups.runCtors();
m_invalidMeshGeometry.resize(meshCount);
m_invalidMeshGeometry.runCtors();
// One task per mesh.
Array<MeshComputeChartsTaskArgs> taskArgs;
taskArgs.resize(meshCount);
for (uint32_t i = 0; i < meshCount; i++) {
MeshComputeChartsTaskArgs &args = taskArgs[i];
args.sourceMesh = m_meshes[i];
args.chartGroups = &m_meshChartGroups[i];
args.invalidMeshGeometry = &m_invalidMeshGeometry[i];
}
// Sort meshes by indexCount.
Array<float> meshSortData;
meshSortData.resize(meshCount);
for (uint32_t i = 0; i < meshCount; i++)
meshSortData[i] = (float)m_meshes[i]->indexCount();
RadixSort meshSort;
meshSort.sort(meshSortData);
// Larger meshes are added first to reduce the chance of thread starvation.
ThreadLocal<segment::Atlas> atlas;
ThreadLocal<UniformGrid2> boundaryGrid; // For Quality boundary intersection.
ThreadLocal<ChartCtorBuffers> chartBuffers;
ThreadLocal<PiecewiseParam> piecewiseParam;
MeshComputeChartsTaskGroupArgs taskGroupArgs;
taskGroupArgs.atlas = &atlas;
taskGroupArgs.options = &options;
taskGroupArgs.progress = &progress;
taskGroupArgs.taskScheduler = taskScheduler;
taskGroupArgs.boundaryGrid = &boundaryGrid;
taskGroupArgs.chartBuffers = &chartBuffers;
taskGroupArgs.piecewiseParam = &piecewiseParam;
TaskGroupHandle taskGroup = taskScheduler->createTaskGroup(&taskGroupArgs, meshCount);
for (uint32_t i = 0; i < meshCount; i++) {
Task task;
task.userData = &taskArgs[meshSort.ranks()[meshCount - i - 1]];
task.func = runMeshComputeChartsTask;
taskScheduler->run(taskGroup, task);
}
taskScheduler->wait(&taskGroup);
XA_PROFILE_END(computeChartsReal)
if (progress.cancel)
return false;
m_chartsComputed = true;
return true;
}
private:
Array<const Mesh *> m_meshes;
Array<InvalidMeshGeometry> m_invalidMeshGeometry; // 1 per mesh.
Array<Array<ChartGroup *>> m_meshChartGroups;
bool m_chartsComputed;
};
} // namespace param
namespace pack {
class AtlasImage {
public:
AtlasImage(uint32_t width, uint32_t height) :
m_width(width), m_height(height) {
m_data.resize(m_width * m_height);
memset(m_data.data(), 0, sizeof(uint32_t) * m_data.size());
}
void resize(uint32_t width, uint32_t height) {
Array<uint32_t> data;
data.resize(width * height);
memset(data.data(), 0, sizeof(uint32_t) * data.size());
for (uint32_t y = 0; y < min(m_height, height); y++)
memcpy(&data[y * width], &m_data[y * m_width], min(m_width, width) * sizeof(uint32_t));
m_width = width;
m_height = height;
data.moveTo(m_data);
}
void addChart(uint32_t chartIndex, const BitImage *image, const BitImage *imageBilinear, const BitImage *imagePadding, int atlas_w, int atlas_h, int offset_x, int offset_y) {
const int w = image->width();
const int h = image->height();
for (int y = 0; y < h; y++) {
const int yy = y + offset_y;
if (yy < 0)
continue;
for (int x = 0; x < w; x++) {
const int xx = x + offset_x;
if (xx >= 0 && xx < atlas_w && yy < atlas_h) {
const uint32_t dataOffset = xx + yy * m_width;
if (image->get(x, y)) {
XA_DEBUG_ASSERT(m_data[dataOffset] == 0);
m_data[dataOffset] = chartIndex | kImageHasChartIndexBit;
} else if (imageBilinear && imageBilinear->get(x, y)) {
XA_DEBUG_ASSERT(m_data[dataOffset] == 0);
m_data[dataOffset] = chartIndex | kImageHasChartIndexBit | kImageIsBilinearBit;
} else if (imagePadding && imagePadding->get(x, y)) {
XA_DEBUG_ASSERT(m_data[dataOffset] == 0);
m_data[dataOffset] = chartIndex | kImageHasChartIndexBit | kImageIsPaddingBit;
}
}
}
}
}
void copyTo(uint32_t *dest, uint32_t destWidth, uint32_t destHeight, int padding) const {
for (uint32_t y = 0; y < destHeight; y++)
memcpy(&dest[y * destWidth], &m_data[padding + (y + padding) * m_width], destWidth * sizeof(uint32_t));
}
#if XA_DEBUG_EXPORT_ATLAS_IMAGES
void writeTga(const char *filename, uint32_t width, uint32_t height) const {
Array<uint8_t> image;
image.resize(width * height * 3);
for (uint32_t y = 0; y < height; y++) {
if (y >= m_height)
continue;
for (uint32_t x = 0; x < width; x++) {
if (x >= m_width)
continue;
const uint32_t data = m_data[x + y * m_width];
uint8_t *bgr = &image[(x + y * width) * 3];
if (data == 0) {
bgr[0] = bgr[1] = bgr[2] = 0;
continue;
}
const uint32_t chartIndex = data & kImageChartIndexMask;
if (data & kImageIsPaddingBit) {
bgr[0] = 0;
bgr[1] = 0;
bgr[2] = 255;
} else if (data & kImageIsBilinearBit) {
bgr[0] = 0;
bgr[1] = 255;
bgr[2] = 0;
} else {
const int mix = 192;
srand((unsigned int)chartIndex);
bgr[0] = uint8_t((rand() % 255 + mix) * 0.5f);
bgr[1] = uint8_t((rand() % 255 + mix) * 0.5f);
bgr[2] = uint8_t((rand() % 255 + mix) * 0.5f);
}
}
}
WriteTga(filename, image.data(), width, height);
}
#endif
private:
uint32_t m_width, m_height;
Array<uint32_t> m_data;
};
struct Chart {
int32_t atlasIndex;
uint32_t material;
ConstArrayView<uint32_t> indices;
float parametricArea;
float surfaceArea;
ArrayView<Vector2> vertices;
Array<uint32_t> uniqueVertices;
// bounding box
Vector2 majorAxis, minorAxis, minCorner, maxCorner;
// Mesh only
const Array<uint32_t> *boundaryEdges;
// UvMeshChart only
Array<uint32_t> faces;
Vector2 &uniqueVertexAt(uint32_t v) { return uniqueVertices.isEmpty() ? vertices[v] : vertices[uniqueVertices[v]]; }
uint32_t uniqueVertexCount() const { return uniqueVertices.isEmpty() ? vertices.length : uniqueVertices.size(); }
};
struct AddChartTaskArgs {
param::Chart *paramChart;
Chart *chart; // out
};
static void runAddChartTask(void *groupUserData, void *taskUserData) {
XA_PROFILE_START(packChartsAddChartsThread)
auto boundingBox = (ThreadLocal<BoundingBox2D> *)groupUserData;
auto args = (AddChartTaskArgs *)taskUserData;
param::Chart *paramChart = args->paramChart;
XA_PROFILE_START(packChartsAddChartsRestoreTexcoords)
paramChart->restoreTexcoords();
XA_PROFILE_END(packChartsAddChartsRestoreTexcoords)
Mesh *mesh = paramChart->unifiedMesh();
Chart *chart = args->chart = XA_NEW(MemTag::Default, Chart);
chart->atlasIndex = -1;
chart->material = 0;
chart->indices = mesh->indices();
chart->parametricArea = mesh->computeParametricArea();
if (chart->parametricArea < kAreaEpsilon) {
// When the parametric area is too small we use a rough approximation to prevent divisions by very small numbers.
const Vector2 bounds = paramChart->computeParametricBounds();
chart->parametricArea = bounds.x * bounds.y;
}
chart->surfaceArea = mesh->computeSurfaceArea();
chart->vertices = mesh->texcoords();
chart->boundaryEdges = &mesh->boundaryEdges();
// Compute bounding box of chart.
BoundingBox2D &bb = boundingBox->get();
bb.clear();
for (uint32_t v = 0; v < chart->vertices.length; v++) {
if (mesh->isBoundaryVertex(v))
bb.appendBoundaryVertex(mesh->texcoord(v));
}
bb.compute(mesh->texcoords());
chart->majorAxis = bb.majorAxis;
chart->minorAxis = bb.minorAxis;
chart->minCorner = bb.minCorner;
chart->maxCorner = bb.maxCorner;
XA_PROFILE_END(packChartsAddChartsThread)
}
struct Atlas {
~Atlas() {
for (uint32_t i = 0; i < m_atlasImages.size(); i++) {
m_atlasImages[i]->~AtlasImage();
XA_FREE(m_atlasImages[i]);
}
for (uint32_t i = 0; i < m_bitImages.size(); i++) {
m_bitImages[i]->~BitImage();
XA_FREE(m_bitImages[i]);
}
for (uint32_t i = 0; i < m_charts.size(); i++) {
m_charts[i]->~Chart();
XA_FREE(m_charts[i]);
}
}
uint32_t getWidth() const { return m_width; }
uint32_t getHeight() const { return m_height; }
uint32_t getNumAtlases() const { return m_bitImages.size(); }
float getTexelsPerUnit() const { return m_texelsPerUnit; }
const Chart *getChart(uint32_t index) const { return m_charts[index]; }
uint32_t getChartCount() const { return m_charts.size(); }
const Array<AtlasImage *> &getImages() const { return m_atlasImages; }
float getUtilization(uint32_t atlas) const { return m_utilization[atlas]; }
void addCharts(TaskScheduler *taskScheduler, param::Atlas *paramAtlas) {
// Count charts.
uint32_t chartCount = 0;
for (uint32_t i = 0; i < paramAtlas->meshCount(); i++) {
const uint32_t chartGroupsCount = paramAtlas->chartGroupCount(i);
for (uint32_t j = 0; j < chartGroupsCount; j++) {
const param::ChartGroup *chartGroup = paramAtlas->chartGroupAt(i, j);
chartCount += chartGroup->chartCount();
}
}
if (chartCount == 0)
return;
// Run one task per chart.
ThreadLocal<BoundingBox2D> boundingBox;
TaskGroupHandle taskGroup = taskScheduler->createTaskGroup(&boundingBox, chartCount);
Array<AddChartTaskArgs> taskArgs;
taskArgs.resize(chartCount);
uint32_t chartIndex = 0;
for (uint32_t i = 0; i < paramAtlas->meshCount(); i++) {
const uint32_t chartGroupsCount = paramAtlas->chartGroupCount(i);
for (uint32_t j = 0; j < chartGroupsCount; j++) {
const param::ChartGroup *chartGroup = paramAtlas->chartGroupAt(i, j);
const uint32_t count = chartGroup->chartCount();
for (uint32_t k = 0; k < count; k++) {
AddChartTaskArgs &args = taskArgs[chartIndex];
args.paramChart = chartGroup->chartAt(k);
Task task;
task.userData = &taskArgs[chartIndex];
task.func = runAddChartTask;
taskScheduler->run(taskGroup, task);
chartIndex++;
}
}
}
taskScheduler->wait(&taskGroup);
// Get task output.
m_charts.resize(chartCount);
for (uint32_t i = 0; i < chartCount; i++)
m_charts[i] = taskArgs[i].chart;
}
void addUvMeshCharts(UvMeshInstance *mesh) {
// Copy texcoords from mesh.
mesh->texcoords.resize(mesh->mesh->texcoords.size());
memcpy(mesh->texcoords.data(), mesh->mesh->texcoords.data(), mesh->texcoords.size() * sizeof(Vector2));
BitArray vertexUsed(mesh->texcoords.size());
BoundingBox2D boundingBox;
for (uint32_t c = 0; c < mesh->mesh->charts.size(); c++) {
UvMeshChart *uvChart = mesh->mesh->charts[c];
Chart *chart = XA_NEW(MemTag::Default, Chart);
chart->atlasIndex = -1;
chart->material = uvChart->material;
chart->indices = uvChart->indices;
chart->vertices = mesh->texcoords;
chart->boundaryEdges = nullptr;
chart->faces.resize(uvChart->faces.size());
memcpy(chart->faces.data(), uvChart->faces.data(), sizeof(uint32_t) * uvChart->faces.size());
// Find unique vertices.
vertexUsed.zeroOutMemory();
for (uint32_t i = 0; i < chart->indices.length; i++) {
const uint32_t vertex = chart->indices[i];
if (!vertexUsed.get(vertex)) {
vertexUsed.set(vertex);
chart->uniqueVertices.push_back(vertex);
}
}
// Compute parametric and surface areas.
chart->parametricArea = 0.0f;
for (uint32_t f = 0; f < chart->indices.length / 3; f++) {
const Vector2 &v1 = chart->vertices[chart->indices[f * 3 + 0]];
const Vector2 &v2 = chart->vertices[chart->indices[f * 3 + 1]];
const Vector2 &v3 = chart->vertices[chart->indices[f * 3 + 2]];
chart->parametricArea += fabsf(triangleArea(v1, v2, v3));
}
chart->parametricArea *= 0.5f;
if (chart->parametricArea < kAreaEpsilon) {
// When the parametric area is too small we use a rough approximation to prevent divisions by very small numbers.
Vector2 minCorner(FLT_MAX, FLT_MAX);
Vector2 maxCorner(-FLT_MAX, -FLT_MAX);
for (uint32_t v = 0; v < chart->uniqueVertexCount(); v++) {
minCorner = min(minCorner, chart->uniqueVertexAt(v));
maxCorner = max(maxCorner, chart->uniqueVertexAt(v));
}
const Vector2 bounds = (maxCorner - minCorner) * 0.5f;
chart->parametricArea = bounds.x * bounds.y;
}
XA_DEBUG_ASSERT(isFinite(chart->parametricArea));
XA_DEBUG_ASSERT(!isNan(chart->parametricArea));
chart->surfaceArea = chart->parametricArea; // Identical for UV meshes.
// Compute bounding box of chart.
// Using all unique vertices for simplicity, can compute real boundaries if this is too slow.
boundingBox.clear();
for (uint32_t v = 0; v < chart->uniqueVertexCount(); v++)
boundingBox.appendBoundaryVertex(chart->uniqueVertexAt(v));
boundingBox.compute();
chart->majorAxis = boundingBox.majorAxis;
chart->minorAxis = boundingBox.minorAxis;
chart->minCorner = boundingBox.minCorner;
chart->maxCorner = boundingBox.maxCorner;
m_charts.push_back(chart);
}
}
// Pack charts in the smallest possible rectangle.
bool packCharts(const PackOptions &options, ProgressFunc progressFunc, void *progressUserData) {
if (progressFunc) {
if (!progressFunc(ProgressCategory::PackCharts, 0, progressUserData))
return false;
}
const uint32_t chartCount = m_charts.size();
XA_PRINT("Packing %u charts\n", chartCount);
if (chartCount == 0) {
if (progressFunc) {
if (!progressFunc(ProgressCategory::PackCharts, 100, progressUserData))
return false;
}
return true;
}
// Estimate resolution and/or texels per unit if not specified.
m_texelsPerUnit = options.texelsPerUnit;
uint32_t resolution = options.resolution > 0 ? options.resolution + options.padding * 2 : 0;
const uint32_t maxResolution = m_texelsPerUnit > 0.0f ? resolution : 0;
if (resolution <= 0 || m_texelsPerUnit <= 0) {
if (resolution <= 0 && m_texelsPerUnit <= 0)
resolution = 1024;
float meshArea = 0;
for (uint32_t c = 0; c < chartCount; c++)
meshArea += m_charts[c]->surfaceArea;
if (resolution <= 0) {
// Estimate resolution based on the mesh surface area and given texel scale.
const float texelCount = max(1.0f, meshArea * square(m_texelsPerUnit) / 0.75f); // Assume 75% utilization.
resolution = max(1u, nextPowerOfTwo(uint32_t(sqrtf(texelCount))));
}
if (m_texelsPerUnit <= 0) {
// Estimate a suitable texelsPerUnit to fit the given resolution.
const float texelCount = max(1.0f, meshArea / 0.75f); // Assume 75% utilization.
m_texelsPerUnit = sqrtf((resolution * resolution) / texelCount);
XA_PRINT(" Estimating texelsPerUnit as %g\n", m_texelsPerUnit);
}
}
Array<float> chartOrderArray;
chartOrderArray.resize(chartCount);
Array<Vector2> chartExtents;
chartExtents.resize(chartCount);
float minChartPerimeter = FLT_MAX, maxChartPerimeter = 0.0f;
for (uint32_t c = 0; c < chartCount; c++) {
Chart *chart = m_charts[c];
// Compute chart scale
float scale = 1.0f;
if (chart->parametricArea != 0.0f) {
scale = sqrtf(chart->surfaceArea / chart->parametricArea) * m_texelsPerUnit;
XA_ASSERT(isFinite(scale));
}
// Translate, rotate and scale vertices. Compute extents.
Vector2 minCorner(FLT_MAX, FLT_MAX);
if (!options.rotateChartsToAxis) {
for (uint32_t i = 0; i < chart->uniqueVertexCount(); i++)
minCorner = min(minCorner, chart->uniqueVertexAt(i));
}
Vector2 extents(0.0f);
for (uint32_t i = 0; i < chart->uniqueVertexCount(); i++) {
Vector2 &texcoord = chart->uniqueVertexAt(i);
if (options.rotateChartsToAxis) {
const float x = dot(texcoord, chart->majorAxis);
const float y = dot(texcoord, chart->minorAxis);
texcoord.x = x;
texcoord.y = y;
texcoord -= chart->minCorner;
} else {
texcoord -= minCorner;
}
texcoord *= scale;
XA_DEBUG_ASSERT(texcoord.x >= 0.0f && texcoord.y >= 0.0f);
XA_DEBUG_ASSERT(isFinite(texcoord.x) && isFinite(texcoord.y));
extents = max(extents, texcoord);
}
XA_DEBUG_ASSERT(extents.x >= 0 && extents.y >= 0);
// Scale the charts to use the entire texel area available. So, if the width is 0.1 we could scale it to 1 without increasing the lightmap usage and making a better use of it. In many cases this also improves the look of the seams, since vertices on the chart boundaries have more chances of being aligned with the texel centers.
if (extents.x > 0.0f && extents.y > 0.0f) {
// Block align: align all chart extents to 4x4 blocks, but taking padding and texel center offset into account.
const int blockAlignSizeOffset = options.padding * 2 + 1;
int width = ftoi_ceil(extents.x);
if (options.blockAlign)
width = align(width + blockAlignSizeOffset, 4) - blockAlignSizeOffset;
int height = ftoi_ceil(extents.y);
if (options.blockAlign)
height = align(height + blockAlignSizeOffset, 4) - blockAlignSizeOffset;
for (uint32_t v = 0; v < chart->uniqueVertexCount(); v++) {
Vector2 &texcoord = chart->uniqueVertexAt(v);
texcoord.x = texcoord.x / extents.x * (float)width;
texcoord.y = texcoord.y / extents.y * (float)height;
}
extents.x = (float)width;
extents.y = (float)height;
}
// Limit chart size, either to PackOptions::maxChartSize or maxResolution (if set), whichever is smaller.
// If limiting chart size to maxResolution, print a warning, since that may not be desirable to the user.
uint32_t maxChartSize = options.maxChartSize;
bool warnChartResized = false;
if (maxResolution > 0 && (maxChartSize == 0 || maxResolution < maxChartSize)) {
maxChartSize = maxResolution - options.padding * 2; // Don't include padding.
warnChartResized = true;
}
if (maxChartSize > 0) {
const float realMaxChartSize = (float)maxChartSize - 1.0f; // Aligning to texel centers increases texel footprint by 1.
if (extents.x > realMaxChartSize || extents.y > realMaxChartSize) {
if (warnChartResized)
XA_PRINT(" Resizing chart %u from %gx%g to %ux%u to fit atlas\n", c, extents.x, extents.y, maxChartSize, maxChartSize);
scale = realMaxChartSize / max(extents.x, extents.y);
for (uint32_t i = 0; i < chart->uniqueVertexCount(); i++) {
Vector2 &texcoord = chart->uniqueVertexAt(i);
texcoord = min(texcoord * scale, Vector2(realMaxChartSize));
}
}
}
// Align to texel centers and add padding offset.
extents.x = extents.y = 0.0f;
for (uint32_t v = 0; v < chart->uniqueVertexCount(); v++) {
Vector2 &texcoord = chart->uniqueVertexAt(v);
texcoord.x += 0.5f + options.padding;
texcoord.y += 0.5f + options.padding;
extents = max(extents, texcoord);
}
if (extents.x > resolution || extents.y > resolution)
XA_PRINT(" Chart %u extents are large (%gx%g)\n", c, extents.x, extents.y);
chartExtents[c] = extents;
chartOrderArray[c] = extents.x + extents.y; // Use perimeter for chart sort key.
minChartPerimeter = min(minChartPerimeter, chartOrderArray[c]);
maxChartPerimeter = max(maxChartPerimeter, chartOrderArray[c]);
}
// Sort charts by perimeter.
m_radix.sort(chartOrderArray);
const uint32_t *ranks = m_radix.ranks();
// Divide chart perimeter range into buckets.
const float chartPerimeterBucketSize = (maxChartPerimeter - minChartPerimeter) / 16.0f;
uint32_t currentChartBucket = 0;
Array<Vector2i> chartStartPositions; // per atlas
chartStartPositions.push_back(Vector2i(0, 0));
// Pack sorted charts.
#if XA_DEBUG_EXPORT_ATLAS_IMAGES
const bool createImage = true;
#else
const bool createImage = options.createImage;
#endif
// chartImage: result from conservative rasterization
// chartImageBilinear: chartImage plus any texels that would be sampled by bilinear filtering.
// chartImagePadding: either chartImage or chartImageBilinear depending on options, with a dilate filter applied options.padding times.
// Rotated versions swap x and y.
BitImage chartImage, chartImageBilinear, chartImagePadding;
BitImage chartImageRotated, chartImageBilinearRotated, chartImagePaddingRotated;
UniformGrid2 boundaryEdgeGrid;
Array<Vector2i> atlasSizes;
atlasSizes.push_back(Vector2i(0, 0));
int progress = 0;
for (uint32_t i = 0; i < chartCount; i++) {
uint32_t c = ranks[chartCount - i - 1]; // largest chart first
Chart *chart = m_charts[c];
// @@ Add special cases for dot and line charts. @@ Lightmap rasterizer also needs to handle these special cases.
// @@ We could also have a special case for chart quads. If the quad surface <= 4 texels, align vertices with texel centers and do not add padding. May be very useful for foliage.
// @@ In general we could reduce the padding of all charts by one texel by using a rasterizer that takes into account the 2-texel footprint of the tent bilinear filter. For example,
// if we have a chart that is less than 1 texel wide currently we add one texel to the left and one texel to the right creating a 3-texel-wide bitImage. However, if we know that the
// chart is only 1 texel wide we could align it so that it only touches the footprint of two texels:
// | | <- Touches texels 0, 1 and 2.
// | | <- Only touches texels 0 and 1.
// \ \ / \ / /
// \ X X /
// \ / \ / \ /
// V V V
// 0 1 2
XA_PROFILE_START(packChartsRasterize)
// Resize and clear (discard = true) chart images.
// Leave room for padding at extents.
chartImage.resize(ftoi_ceil(chartExtents[c].x) + options.padding, ftoi_ceil(chartExtents[c].y) + options.padding, true);
if (options.rotateCharts)
chartImageRotated.resize(chartImage.height(), chartImage.width(), true);
if (options.bilinear) {
chartImageBilinear.resize(chartImage.width(), chartImage.height(), true);
if (options.rotateCharts)
chartImageBilinearRotated.resize(chartImage.height(), chartImage.width(), true);
}
// Rasterize chart faces.
const uint32_t faceCount = chart->indices.length / 3;
for (uint32_t f = 0; f < faceCount; f++) {
Vector2 vertices[3];
for (uint32_t v = 0; v < 3; v++)
vertices[v] = chart->vertices[chart->indices[f * 3 + v]];
DrawTriangleCallbackArgs args;
args.chartBitImage = &chartImage;
args.chartBitImageRotated = options.rotateCharts ? &chartImageRotated : nullptr;
raster::drawTriangle(Vector2((float)chartImage.width(), (float)chartImage.height()), vertices, drawTriangleCallback, &args);
}
// Expand chart by pixels sampled by bilinear interpolation.
if (options.bilinear)
bilinearExpand(chart, &chartImage, &chartImageBilinear, options.rotateCharts ? &chartImageBilinearRotated : nullptr, boundaryEdgeGrid);
// Expand chart by padding pixels (dilation).
if (options.padding > 0) {
// Copy into the same BitImage instances for every chart to avoid reallocating BitImage buffers (largest chart is packed first).
XA_PROFILE_START(packChartsDilate)
if (options.bilinear)
chartImageBilinear.copyTo(chartImagePadding);
else
chartImage.copyTo(chartImagePadding);
chartImagePadding.dilate(options.padding);
if (options.rotateCharts) {
if (options.bilinear)
chartImageBilinearRotated.copyTo(chartImagePaddingRotated);
else
chartImageRotated.copyTo(chartImagePaddingRotated);
chartImagePaddingRotated.dilate(options.padding);
}
XA_PROFILE_END(packChartsDilate)
}
XA_PROFILE_END(packChartsRasterize)
// Update brute force bucketing.
if (options.bruteForce) {
if (chartOrderArray[c] > minChartPerimeter && chartOrderArray[c] <= maxChartPerimeter - (chartPerimeterBucketSize * (currentChartBucket + 1))) {
// Moved to a smaller bucket, reset start location.
for (uint32_t j = 0; j < chartStartPositions.size(); j++)
chartStartPositions[j] = Vector2i(0, 0);
currentChartBucket++;
}
}
// Find a location to place the chart in the atlas.
BitImage *chartImageToPack, *chartImageToPackRotated;
if (options.padding > 0) {
chartImageToPack = &chartImagePadding;
chartImageToPackRotated = &chartImagePaddingRotated;
} else if (options.bilinear) {
chartImageToPack = &chartImageBilinear;
chartImageToPackRotated = &chartImageBilinearRotated;
} else {
chartImageToPack = &chartImage;
chartImageToPackRotated = &chartImageRotated;
}
uint32_t currentAtlas = 0;
int best_x = 0, best_y = 0;
int best_cw = 0, best_ch = 0;
int best_r = 0;
for (;;) {
#if XA_DEBUG
bool firstChartInBitImage = false;
#endif
if (currentAtlas + 1 > m_bitImages.size()) {
// Chart doesn't fit in the current bitImage, create a new one.
BitImage *bi = XA_NEW_ARGS(MemTag::Default, BitImage, resolution, resolution);
m_bitImages.push_back(bi);
atlasSizes.push_back(Vector2i(0, 0));
#if XA_DEBUG
firstChartInBitImage = true;
#endif
if (createImage)
m_atlasImages.push_back(XA_NEW_ARGS(MemTag::Default, AtlasImage, resolution, resolution));
// Start positions are per-atlas, so create a new one of those too.
chartStartPositions.push_back(Vector2i(0, 0));
}
XA_PROFILE_START(packChartsFindLocation)
const bool foundLocation = findChartLocation(options, chartStartPositions[currentAtlas], m_bitImages[currentAtlas], chartImageToPack, chartImageToPackRotated, atlasSizes[currentAtlas].x, atlasSizes[currentAtlas].y, &best_x, &best_y, &best_cw, &best_ch, &best_r, maxResolution);
XA_PROFILE_END(packChartsFindLocation)
XA_DEBUG_ASSERT(!(firstChartInBitImage && !foundLocation)); // Chart doesn't fit in an empty, newly allocated bitImage. Shouldn't happen, since charts are resized if they are too big to fit in the atlas.
if (maxResolution == 0) {
XA_DEBUG_ASSERT(foundLocation); // The atlas isn't limited to a fixed resolution, a chart location should be found on the first attempt.
break;
}
if (foundLocation)
break;
// Chart doesn't fit in the current bitImage, try the next one.
currentAtlas++;
}
// Update brute force start location.
if (options.bruteForce) {
// Reset start location if the chart expanded the atlas.
if (best_x + best_cw > atlasSizes[currentAtlas].x || best_y + best_ch > atlasSizes[currentAtlas].y) {
for (uint32_t j = 0; j < chartStartPositions.size(); j++)
chartStartPositions[j] = Vector2i(0, 0);
} else {
chartStartPositions[currentAtlas] = Vector2i(best_x, best_y);
}
}
// Update parametric extents.
atlasSizes[currentAtlas].x = max(atlasSizes[currentAtlas].x, best_x + best_cw);
atlasSizes[currentAtlas].y = max(atlasSizes[currentAtlas].y, best_y + best_ch);
// Resize bitImage if necessary.
// If maxResolution > 0, the bitImage is always set to maxResolutionIncludingPadding on creation and doesn't need to be dynamically resized.
if (maxResolution == 0) {
const uint32_t w = (uint32_t)atlasSizes[currentAtlas].x;
const uint32_t h = (uint32_t)atlasSizes[currentAtlas].y;
if (w > m_bitImages[0]->width() || h > m_bitImages[0]->height()) {
m_bitImages[0]->resize(nextPowerOfTwo(w), nextPowerOfTwo(h), false);
if (createImage)
m_atlasImages[0]->resize(m_bitImages[0]->width(), m_bitImages[0]->height());
}
} else {
XA_DEBUG_ASSERT(atlasSizes[currentAtlas].x <= (int)maxResolution);
XA_DEBUG_ASSERT(atlasSizes[currentAtlas].y <= (int)maxResolution);
}
XA_PROFILE_START(packChartsBlit)
addChart(m_bitImages[currentAtlas], chartImageToPack, chartImageToPackRotated, atlasSizes[currentAtlas].x, atlasSizes[currentAtlas].y, best_x, best_y, best_r);
XA_PROFILE_END(packChartsBlit)
if (createImage) {
if (best_r == 0) {
m_atlasImages[currentAtlas]->addChart(c, &chartImage, options.bilinear ? &chartImageBilinear : nullptr, options.padding > 0 ? &chartImagePadding : nullptr, atlasSizes[currentAtlas].x, atlasSizes[currentAtlas].y, best_x, best_y);
} else {
m_atlasImages[currentAtlas]->addChart(c, &chartImageRotated, options.bilinear ? &chartImageBilinearRotated : nullptr, options.padding > 0 ? &chartImagePaddingRotated : nullptr, atlasSizes[currentAtlas].x, atlasSizes[currentAtlas].y, best_x, best_y);
}
#if XA_DEBUG_EXPORT_ATLAS_IMAGES && XA_DEBUG_EXPORT_ATLAS_IMAGES_PER_CHART
for (uint32_t j = 0; j < m_atlasImages.size(); j++) {
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_atlas_image%02u_chart%04u.tga", j, i);
m_atlasImages[j]->writeTga(filename, (uint32_t)atlasSizes[j].x, (uint32_t)atlasSizes[j].y);
}
#endif
}
chart->atlasIndex = (int32_t)currentAtlas;
// Modify texture coordinates:
// - rotate if the chart should be rotated
// - translate to chart location
// - translate to remove padding from top and left atlas edges (unless block aligned)
for (uint32_t v = 0; v < chart->uniqueVertexCount(); v++) {
Vector2 &texcoord = chart->uniqueVertexAt(v);
Vector2 t = texcoord;
if (best_r) {
XA_DEBUG_ASSERT(options.rotateCharts);
swap(t.x, t.y);
}
texcoord.x = best_x + t.x;
texcoord.y = best_y + t.y;
texcoord.x -= (float)options.padding;
texcoord.y -= (float)options.padding;
XA_ASSERT(texcoord.x >= 0 && texcoord.y >= 0);
XA_ASSERT(isFinite(texcoord.x) && isFinite(texcoord.y));
}
if (progressFunc) {
const int newProgress = int((i + 1) / (float)chartCount * 100.0f);
if (newProgress != progress) {
progress = newProgress;
if (!progressFunc(ProgressCategory::PackCharts, progress, progressUserData))
return false;
}
}
}
// Remove padding from outer edges.
if (maxResolution == 0) {
m_width = max(0, atlasSizes[0].x - (int)options.padding * 2);
m_height = max(0, atlasSizes[0].y - (int)options.padding * 2);
} else {
m_width = m_height = maxResolution - (int)options.padding * 2;
}
XA_PRINT(" %dx%d resolution\n", m_width, m_height);
m_utilization.resize(m_bitImages.size());
for (uint32_t i = 0; i < m_utilization.size(); i++) {
if (m_width == 0 || m_height == 0)
m_utilization[i] = 0.0f;
else {
uint32_t count = 0;
for (uint32_t y = 0; y < m_height; y++) {
for (uint32_t x = 0; x < m_width; x++)
count += m_bitImages[i]->get(x, y);
}
m_utilization[i] = float(count) / (m_width * m_height);
}
if (m_utilization.size() > 1) {
XA_PRINT(" %u: %f%% utilization\n", i, m_utilization[i] * 100.0f);
} else {
XA_PRINT(" %f%% utilization\n", m_utilization[i] * 100.0f);
}
}
#if XA_DEBUG_EXPORT_ATLAS_IMAGES
for (uint32_t i = 0; i < m_atlasImages.size(); i++) {
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_atlas_image%02u.tga", i);
m_atlasImages[i]->writeTga(filename, m_width, m_height);
}
#endif
if (progressFunc && progress != 100) {
if (!progressFunc(ProgressCategory::PackCharts, 100, progressUserData))
return false;
}
return true;
}
private:
bool findChartLocation(const PackOptions &options, const Vector2i &startPosition, const BitImage *atlasBitImage, const BitImage *chartBitImage, const BitImage *chartBitImageRotated, int w, int h, int *best_x, int *best_y, int *best_w, int *best_h, int *best_r, uint32_t maxResolution) {
const int attempts = 4096;
if (options.bruteForce || attempts >= w * h)
return findChartLocation_bruteForce(options, startPosition, atlasBitImage, chartBitImage, chartBitImageRotated, w, h, best_x, best_y, best_w, best_h, best_r, maxResolution);
return findChartLocation_random(options, atlasBitImage, chartBitImage, chartBitImageRotated, w, h, best_x, best_y, best_w, best_h, best_r, attempts, maxResolution);
}
bool findChartLocation_bruteForce(const PackOptions &options, const Vector2i &startPosition, const BitImage *atlasBitImage, const BitImage *chartBitImage, const BitImage *chartBitImageRotated, int w, int h, int *best_x, int *best_y, int *best_w, int *best_h, int *best_r, uint32_t maxResolution) {
const int stepSize = options.blockAlign ? 4 : 1;
int best_metric = INT_MAX;
// Try two different orientations.
for (int r = 0; r < 2; r++) {
int cw = chartBitImage->width();
int ch = chartBitImage->height();
if (r == 1) {
if (options.rotateCharts)
swap(cw, ch);
else
break;
}
for (int y = startPosition.y; y <= h + stepSize; y += stepSize) {
if (maxResolution > 0 && y > (int)maxResolution - ch)
break;
for (int x = (y == startPosition.y ? startPosition.x : 0); x <= w + stepSize; x += stepSize) {
if (maxResolution > 0 && x > (int)maxResolution - cw)
break;
// Early out if metric is not better.
const int extentX = max(w, x + cw), extentY = max(h, y + ch);
const int area = extentX * extentY;
const int extents = max(extentX, extentY);
const int metric = extents * extents + area;
if (metric > best_metric)
continue;
// If metric is the same, pick the one closest to the origin.
if (metric == best_metric && max(x, y) >= max(*best_x, *best_y))
continue;
if (!atlasBitImage->canBlit(r == 1 ? *chartBitImageRotated : *chartBitImage, x, y))
continue;
best_metric = metric;
*best_x = x;
*best_y = y;
*best_w = cw;
*best_h = ch;
*best_r = r;
if (area == w * h)
return true; // Chart is completely inside, do not look at any other location.
}
}
}
return best_metric != INT_MAX;
}
bool findChartLocation_random(const PackOptions &options, const BitImage *atlasBitImage, const BitImage *chartBitImage, const BitImage *chartBitImageRotated, int w, int h, int *best_x, int *best_y, int *best_w, int *best_h, int *best_r, int attempts, uint32_t maxResolution) {
bool result = false;
const int BLOCK_SIZE = 4;
int best_metric = INT_MAX;
for (int i = 0; i < attempts; i++) {
int cw = chartBitImage->width();
int ch = chartBitImage->height();
int r = options.rotateCharts ? m_rand.getRange(1) : 0;
if (r == 1)
swap(cw, ch);
// + 1 to extend atlas in case atlas full. We may want to use a higher number to increase probability of extending atlas.
int xRange = w + 1;
int yRange = h + 1;
// Clamp to max resolution.
if (maxResolution > 0) {
xRange = min(xRange, (int)maxResolution - cw);
yRange = min(yRange, (int)maxResolution - ch);
}
int x = m_rand.getRange(xRange);
int y = m_rand.getRange(yRange);
if (options.blockAlign) {
x = align(x, BLOCK_SIZE);
y = align(y, BLOCK_SIZE);
if (maxResolution > 0 && (x > (int)maxResolution - cw || y > (int)maxResolution - ch))
continue; // Block alignment pushed the chart outside the atlas.
}
// Early out.
int area = max(w, x + cw) * max(h, y + ch);
//int perimeter = max(w, x+cw) + max(h, y+ch);
int extents = max(max(w, x + cw), max(h, y + ch));
int metric = extents * extents + area;
if (metric > best_metric) {
continue;
}
if (metric == best_metric && min(x, y) > min(*best_x, *best_y)) {
// If metric is the same, pick the one closest to the origin.
continue;
}
if (atlasBitImage->canBlit(r == 1 ? *chartBitImageRotated : *chartBitImage, x, y)) {
result = true;
best_metric = metric;
*best_x = x;
*best_y = y;
*best_w = cw;
*best_h = ch;
*best_r = options.rotateCharts ? r : 0;
if (area == w * h) {
// Chart is completely inside, do not look at any other location.
break;
}
}
}
return result;
}
void addChart(BitImage *atlasBitImage, const BitImage *chartBitImage, const BitImage *chartBitImageRotated, int atlas_w, int atlas_h, int offset_x, int offset_y, int r) {
XA_DEBUG_ASSERT(r == 0 || r == 1);
const BitImage *image = r == 0 ? chartBitImage : chartBitImageRotated;
const int w = image->width();
const int h = image->height();
for (int y = 0; y < h; y++) {
int yy = y + offset_y;
if (yy >= 0) {
for (int x = 0; x < w; x++) {
int xx = x + offset_x;
if (xx >= 0) {
if (image->get(x, y)) {
if (xx < atlas_w && yy < atlas_h) {
XA_DEBUG_ASSERT(atlasBitImage->get(xx, yy) == false);
atlasBitImage->set(xx, yy);
}
}
}
}
}
}
}
void bilinearExpand(const Chart *chart, BitImage *source, BitImage *dest, BitImage *destRotated, UniformGrid2 &boundaryEdgeGrid) const {
boundaryEdgeGrid.reset(chart->vertices, chart->indices);
if (chart->boundaryEdges) {
const uint32_t edgeCount = chart->boundaryEdges->size();
for (uint32_t i = 0; i < edgeCount; i++)
boundaryEdgeGrid.append((*chart->boundaryEdges)[i]);
} else {
for (uint32_t i = 0; i < chart->indices.length; i++)
boundaryEdgeGrid.append(i);
}
const int xOffsets[] = { -1, 0, 1, -1, 1, -1, 0, 1 };
const int yOffsets[] = { -1, -1, -1, 0, 0, 1, 1, 1 };
for (uint32_t y = 0; y < source->height(); y++) {
for (uint32_t x = 0; x < source->width(); x++) {
// Copy pixels from source.
if (source->get(x, y))
goto setPixel;
// Empty pixel. If none of of the surrounding pixels are set, this pixel can't be sampled by bilinear interpolation.
{
uint32_t s = 0;
for (; s < 8; s++) {
const int sx = (int)x + xOffsets[s];
const int sy = (int)y + yOffsets[s];
if (sx < 0 || sy < 0 || sx >= (int)source->width() || sy >= (int)source->height())
continue;
if (source->get((uint32_t)sx, (uint32_t)sy))
break;
}
if (s == 8)
continue;
}
{
// If a 2x2 square centered on the pixels centroid intersects the triangle, this pixel will be sampled by bilinear interpolation.
// See "Precomputed Global Illumination in Frostbite (GDC 2018)" page 95
const Vector2 centroid((float)x + 0.5f, (float)y + 0.5f);
const Vector2 squareVertices[4] = {
Vector2(centroid.x - 1.0f, centroid.y - 1.0f),
Vector2(centroid.x + 1.0f, centroid.y - 1.0f),
Vector2(centroid.x + 1.0f, centroid.y + 1.0f),
Vector2(centroid.x - 1.0f, centroid.y + 1.0f)
};
for (uint32_t j = 0; j < 4; j++) {
if (boundaryEdgeGrid.intersect(squareVertices[j], squareVertices[(j + 1) % 4], 0.0f))
goto setPixel;
}
}
continue;
setPixel:
dest->set(x, y);
if (destRotated)
destRotated->set(y, x);
}
}
}
struct DrawTriangleCallbackArgs {
BitImage *chartBitImage, *chartBitImageRotated;
};
static bool drawTriangleCallback(void *param, int x, int y) {
auto args = (DrawTriangleCallbackArgs *)param;
args->chartBitImage->set(x, y);
if (args->chartBitImageRotated)
args->chartBitImageRotated->set(y, x);
return true;
}
Array<AtlasImage *> m_atlasImages;
Array<float> m_utilization;
Array<BitImage *> m_bitImages;
Array<Chart *> m_charts;
RadixSort m_radix;
uint32_t m_width = 0;
uint32_t m_height = 0;
float m_texelsPerUnit = 0.0f;
KISSRng m_rand;
};
} // namespace pack
} // namespace internal
// Used to map triangulated polygons back to polygons.
struct MeshPolygonMapping {
internal::Array<uint8_t> faceVertexCount; // Copied from MeshDecl::faceVertexCount.
internal::Array<uint32_t> triangleToPolygonMap; // Triangle index (mesh face index) to polygon index.
internal::Array<uint32_t> triangleToPolygonIndicesMap; // Triangle indices to polygon indices.
};
struct Context {
Atlas atlas;
internal::Progress *addMeshProgress = nullptr;
internal::TaskGroupHandle addMeshTaskGroup;
internal::param::Atlas paramAtlas;
ProgressFunc progressFunc = nullptr;
void *progressUserData = nullptr;
internal::TaskScheduler *taskScheduler;
internal::Array<internal::Mesh *> meshes;
internal::Array<MeshPolygonMapping *> meshPolygonMappings;
internal::Array<internal::UvMesh *> uvMeshes;
internal::Array<internal::UvMeshInstance *> uvMeshInstances;
bool uvMeshChartsComputed = false;
};
Atlas *Create() {
Context *ctx = XA_NEW(internal::MemTag::Default, Context);
memset(&ctx->atlas, 0, sizeof(Atlas));
ctx->taskScheduler = XA_NEW(internal::MemTag::Default, internal::TaskScheduler);
return &ctx->atlas;
}
static void DestroyOutputMeshes(Context *ctx) {
if (!ctx->atlas.meshes)
return;
for (int i = 0; i < (int)ctx->atlas.meshCount; i++) {
Mesh &mesh = ctx->atlas.meshes[i];
if (mesh.chartArray) {
for (uint32_t j = 0; j < mesh.chartCount; j++) {
if (mesh.chartArray[j].faceArray)
XA_FREE(mesh.chartArray[j].faceArray);
}
XA_FREE(mesh.chartArray);
}
if (mesh.vertexArray)
XA_FREE(mesh.vertexArray);
if (mesh.indexArray)
XA_FREE(mesh.indexArray);
}
XA_FREE(ctx->atlas.meshes);
ctx->atlas.meshes = nullptr;
}
void Destroy(Atlas *atlas) {
XA_DEBUG_ASSERT(atlas);
Context *ctx = (Context *)atlas;
if (atlas->utilization)
XA_FREE(atlas->utilization);
if (atlas->image)
XA_FREE(atlas->image);
DestroyOutputMeshes(ctx);
if (ctx->addMeshProgress) {
ctx->addMeshProgress->cancel = true;
AddMeshJoin(atlas); // frees addMeshProgress
}
ctx->taskScheduler->~TaskScheduler();
XA_FREE(ctx->taskScheduler);
for (uint32_t i = 0; i < ctx->meshes.size(); i++) {
internal::Mesh *mesh = ctx->meshes[i];
mesh->~Mesh();
XA_FREE(mesh);
}
for (uint32_t i = 0; i < ctx->meshPolygonMappings.size(); i++) {
MeshPolygonMapping *mapping = ctx->meshPolygonMappings[i];
if (mapping) {
mapping->~MeshPolygonMapping();
XA_FREE(mapping);
}
}
for (uint32_t i = 0; i < ctx->uvMeshes.size(); i++) {
internal::UvMesh *mesh = ctx->uvMeshes[i];
for (uint32_t j = 0; j < mesh->charts.size(); j++) {
mesh->charts[j]->~UvMeshChart();
XA_FREE(mesh->charts[j]);
}
mesh->~UvMesh();
XA_FREE(mesh);
}
for (uint32_t i = 0; i < ctx->uvMeshInstances.size(); i++) {
internal::UvMeshInstance *mesh = ctx->uvMeshInstances[i];
mesh->~UvMeshInstance();
XA_FREE(mesh);
}
ctx->~Context();
XA_FREE(ctx);
#if XA_DEBUG_HEAP
internal::ReportLeaks();
#endif
}
static void runAddMeshTask(void *groupUserData, void *taskUserData) {
auto ctx = (Context *)groupUserData;
//auto mesh = (internal::Mesh *)taskUserData;
internal::Progress *progress = ctx->addMeshProgress;
progress->increment(1);
}
static internal::Vector3 DecodePosition(const MeshDecl &meshDecl, uint32_t index) {
XA_DEBUG_ASSERT(meshDecl.vertexPositionData);
XA_DEBUG_ASSERT(meshDecl.vertexPositionStride > 0);
return *((const internal::Vector3 *)&((const uint8_t *)meshDecl.vertexPositionData)[meshDecl.vertexPositionStride * index]);
}
static internal::Vector3 DecodeNormal(const MeshDecl &meshDecl, uint32_t index) {
XA_DEBUG_ASSERT(meshDecl.vertexNormalData);
XA_DEBUG_ASSERT(meshDecl.vertexNormalStride > 0);
return *((const internal::Vector3 *)&((const uint8_t *)meshDecl.vertexNormalData)[meshDecl.vertexNormalStride * index]);
}
static internal::Vector2 DecodeUv(const MeshDecl &meshDecl, uint32_t index) {
XA_DEBUG_ASSERT(meshDecl.vertexUvData);
XA_DEBUG_ASSERT(meshDecl.vertexUvStride > 0);
return *((const internal::Vector2 *)&((const uint8_t *)meshDecl.vertexUvData)[meshDecl.vertexUvStride * index]);
}
static uint32_t DecodeIndex(IndexFormat format, const void *indexData, int32_t offset, uint32_t i) {
XA_DEBUG_ASSERT(indexData);
if (format == IndexFormat::UInt16)
return uint16_t((int32_t)((const uint16_t *)indexData)[i] + offset);
return uint32_t((int32_t)((const uint32_t *)indexData)[i] + offset);
}
AddMeshError AddMesh(Atlas *atlas, const MeshDecl &meshDecl, uint32_t meshCountHint) {
XA_DEBUG_ASSERT(atlas);
if (!atlas) {
XA_PRINT_WARNING("AddMesh: atlas is null.\n");
return AddMeshError::Error;
}
Context *ctx = (Context *)atlas;
if (!ctx->uvMeshes.isEmpty()) {
XA_PRINT_WARNING("AddMesh: Meshes and UV meshes cannot be added to the same atlas.\n");
return AddMeshError::Error;
}
#if XA_PROFILE
if (ctx->meshes.isEmpty())
internal::s_profile.addMeshRealStart = std::chrono::high_resolution_clock::now();
#endif
// Don't know how many times AddMesh will be called, so progress needs to adjusted each time.
if (!ctx->addMeshProgress) {
ctx->addMeshProgress = XA_NEW_ARGS(internal::MemTag::Default, internal::Progress, ProgressCategory::AddMesh, ctx->progressFunc, ctx->progressUserData, 1);
} else {
ctx->addMeshProgress->setMaxValue(internal::max(ctx->meshes.size() + 1, meshCountHint));
}
XA_PROFILE_START(addMeshCopyData)
const bool hasIndices = meshDecl.indexCount > 0;
const uint32_t indexCount = hasIndices ? meshDecl.indexCount : meshDecl.vertexCount;
uint32_t faceCount = indexCount / 3;
if (meshDecl.faceVertexCount) {
faceCount = meshDecl.faceCount;
XA_PRINT("Adding mesh %d: %u vertices, %u polygons\n", ctx->meshes.size(), meshDecl.vertexCount, faceCount);
for (uint32_t f = 0; f < faceCount; f++) {
if (meshDecl.faceVertexCount[f] < 3)
return AddMeshError::InvalidFaceVertexCount;
}
} else {
XA_PRINT("Adding mesh %d: %u vertices, %u triangles\n", ctx->meshes.size(), meshDecl.vertexCount, faceCount);
// Expecting triangle faces unless otherwise specified.
if ((indexCount % 3) != 0)
return AddMeshError::InvalidIndexCount;
}
uint32_t meshFlags = internal::MeshFlags::HasIgnoredFaces;
if (meshDecl.vertexNormalData)
meshFlags |= internal::MeshFlags::HasNormals;
if (meshDecl.faceMaterialData)
meshFlags |= internal::MeshFlags::HasMaterials;
internal::Mesh *mesh = XA_NEW_ARGS(internal::MemTag::Mesh, internal::Mesh, meshDecl.epsilon, meshDecl.vertexCount, indexCount / 3, meshFlags, ctx->meshes.size());
for (uint32_t i = 0; i < meshDecl.vertexCount; i++) {
internal::Vector3 normal(0.0f);
internal::Vector2 texcoord(0.0f);
if (meshDecl.vertexNormalData)
normal = DecodeNormal(meshDecl, i);
if (meshDecl.vertexUvData)
texcoord = DecodeUv(meshDecl, i);
mesh->addVertex(DecodePosition(meshDecl, i), normal, texcoord);
}
MeshPolygonMapping *meshPolygonMapping = nullptr;
if (meshDecl.faceVertexCount) {
meshPolygonMapping = XA_NEW(internal::MemTag::Default, MeshPolygonMapping);
// Copy MeshDecl::faceVertexCount so it can be used later when building output meshes.
meshPolygonMapping->faceVertexCount.copyFrom(meshDecl.faceVertexCount, meshDecl.faceCount);
// There should be at least as many triangles as polygons.
meshPolygonMapping->triangleToPolygonMap.reserve(meshDecl.faceCount);
meshPolygonMapping->triangleToPolygonIndicesMap.reserve(meshDecl.indexCount);
}
const uint32_t kMaxWarnings = 50;
uint32_t warningCount = 0;
internal::Array<uint32_t> triIndices;
//uint32_t firstFaceIndex = 0;
internal::Triangulator triangulator;
for (uint32_t face = 0; face < faceCount; face++) {
// Decode face indices.
const uint32_t faceVertexCount = meshDecl.faceVertexCount ? (uint32_t)meshDecl.faceVertexCount[face] : 3;
uint32_t polygon[UINT8_MAX];
for (uint32_t i = 0; i < faceVertexCount; i++) {
if (hasIndices) {
polygon[i] = DecodeIndex(meshDecl.indexFormat, meshDecl.indexData, meshDecl.indexOffset, face * faceVertexCount + i);
// Check if any index is out of range.
if (polygon[i] >= meshDecl.vertexCount) {
mesh->~Mesh();
XA_FREE(mesh);
return AddMeshError::IndexOutOfRange;
}
} else {
polygon[i] = face * faceVertexCount + i;
}
}
// Ignore faces with degenerate or zero length edges.
bool ignore = false;
for (uint32_t i = 0; i < faceVertexCount; i++) {
const uint32_t index1 = polygon[i];
const uint32_t index2 = polygon[(i + 1) % 3];
if (index1 == index2) {
ignore = true;
if (++warningCount <= kMaxWarnings)
XA_PRINT(" Degenerate edge: index %d, index %d\n", index1, index2);
break;
}
const internal::Vector3 &pos1 = mesh->position(index1);
const internal::Vector3 &pos2 = mesh->position(index2);
if (internal::length(pos2 - pos1) <= 0.0f) {
ignore = true;
if (++warningCount <= kMaxWarnings)
XA_PRINT(" Zero length edge: index %d position (%g %g %g), index %d position (%g %g %g)\n", index1, pos1.x, pos1.y, pos1.z, index2, pos2.x, pos2.y, pos2.z);
break;
}
}
// Ignore faces with any nan vertex attributes.
if (!ignore) {
for (uint32_t i = 0; i < faceVertexCount; i++) {
const internal::Vector3 &pos = mesh->position(polygon[i]);
if (internal::isNan(pos.x) || internal::isNan(pos.y) || internal::isNan(pos.z)) {
if (++warningCount <= kMaxWarnings)
XA_PRINT(" NAN position in face: %d\n", face);
ignore = true;
break;
}
if (meshDecl.vertexNormalData) {
const internal::Vector3 &normal = mesh->normal(polygon[i]);
if (internal::isNan(normal.x) || internal::isNan(normal.y) || internal::isNan(normal.z)) {
if (++warningCount <= kMaxWarnings)
XA_PRINT(" NAN normal in face: %d\n", face);
ignore = true;
break;
}
}
if (meshDecl.vertexUvData) {
const internal::Vector2 &uv = mesh->texcoord(polygon[i]);
if (internal::isNan(uv.x) || internal::isNan(uv.y)) {
if (++warningCount <= kMaxWarnings)
XA_PRINT(" NAN texture coordinate in face: %d\n", face);
ignore = true;
break;
}
}
}
}
// Triangulate if necessary.
triIndices.clear();
if (faceVertexCount == 3) {
triIndices.push_back(polygon[0]);
triIndices.push_back(polygon[1]);
triIndices.push_back(polygon[2]);
} else {
triangulator.triangulatePolygon(mesh->positions(), internal::ConstArrayView<uint32_t>(polygon, faceVertexCount), triIndices);
}
// Check for zero area faces.
if (!ignore) {
for (uint32_t i = 0; i < triIndices.size(); i += 3) {
const internal::Vector3 &a = mesh->position(triIndices[i + 0]);
const internal::Vector3 &b = mesh->position(triIndices[i + 1]);
const internal::Vector3 &c = mesh->position(triIndices[i + 2]);
const float area = internal::length(internal::cross(b - a, c - a)) * 0.5f;
if (area <= internal::kAreaEpsilon) {
ignore = true;
if (++warningCount <= kMaxWarnings)
XA_PRINT(" Zero area face: %d, area is %f\n", face, area);
break;
}
}
}
// User face ignore.
if (meshDecl.faceIgnoreData && meshDecl.faceIgnoreData[face])
ignore = true;
// User material.
uint32_t material = UINT32_MAX;
if (meshDecl.faceMaterialData)
material = meshDecl.faceMaterialData[face];
// Add the face(s).
for (uint32_t i = 0; i < triIndices.size(); i += 3) {
mesh->addFace(&triIndices[i], ignore, material);
if (meshPolygonMapping)
meshPolygonMapping->triangleToPolygonMap.push_back(face);
}
if (meshPolygonMapping) {
for (uint32_t i = 0; i < triIndices.size(); i++)
meshPolygonMapping->triangleToPolygonIndicesMap.push_back(triIndices[i]);
}
//firstFaceIndex += faceVertexCount;
}
if (warningCount > kMaxWarnings)
XA_PRINT(" %u additional warnings truncated\n", warningCount - kMaxWarnings);
XA_PROFILE_END(addMeshCopyData)
ctx->meshes.push_back(mesh);
ctx->meshPolygonMappings.push_back(meshPolygonMapping);
ctx->paramAtlas.addMesh(mesh);
if (ctx->addMeshTaskGroup.value == UINT32_MAX)
ctx->addMeshTaskGroup = ctx->taskScheduler->createTaskGroup(ctx);
internal::Task task;
task.userData = mesh;
task.func = runAddMeshTask;
ctx->taskScheduler->run(ctx->addMeshTaskGroup, task);
return AddMeshError::Success;
}
void AddMeshJoin(Atlas *atlas) {
XA_DEBUG_ASSERT(atlas);
if (!atlas) {
XA_PRINT_WARNING("AddMeshJoin: atlas is null.\n");
return;
}
Context *ctx = (Context *)atlas;
if (!ctx->uvMeshes.isEmpty()) {
#if XA_PROFILE
XA_PRINT("Added %u UV meshes\n", ctx->uvMeshes.size());
internal::s_profile.addMeshReal = uint64_t(std::chrono::duration_cast<std::chrono::microseconds>(std::chrono::high_resolution_clock::now() - internal::s_profile.addMeshRealStart).count());
#endif
XA_PROFILE_PRINT_AND_RESET(" Total: ", addMeshReal)
XA_PROFILE_PRINT_AND_RESET(" Copy data: ", addMeshCopyData)
#if XA_PROFILE_ALLOC
XA_PROFILE_PRINT_AND_RESET(" Alloc: ", alloc)
#endif
XA_PRINT_MEM_USAGE
} else {
if (!ctx->addMeshProgress)
return;
ctx->taskScheduler->wait(&ctx->addMeshTaskGroup);
ctx->addMeshProgress->~Progress();
XA_FREE(ctx->addMeshProgress);
ctx->addMeshProgress = nullptr;
#if XA_PROFILE
XA_PRINT("Added %u meshes\n", ctx->meshes.size());
internal::s_profile.addMeshReal = uint64_t(std::chrono::duration_cast<std::chrono::microseconds>(std::chrono::high_resolution_clock::now() - internal::s_profile.addMeshRealStart).count());
#endif
XA_PROFILE_PRINT_AND_RESET(" Total (real): ", addMeshReal)
XA_PROFILE_PRINT_AND_RESET(" Copy data: ", addMeshCopyData)
XA_PROFILE_PRINT_AND_RESET(" Total (thread): ", addMeshThread)
#if XA_PROFILE_ALLOC
XA_PROFILE_PRINT_AND_RESET(" Alloc: ", alloc)
#endif
XA_PRINT_MEM_USAGE
#if XA_DEBUG_EXPORT_OBJ_FACE_GROUPS
internal::param::s_faceGroupsCurrentVertex = 0;
#endif
}
}
AddMeshError AddUvMesh(Atlas *atlas, const UvMeshDecl &decl) {
XA_DEBUG_ASSERT(atlas);
if (!atlas) {
XA_PRINT_WARNING("AddUvMesh: atlas is null.\n");
return AddMeshError::Error;
}
Context *ctx = (Context *)atlas;
if (!ctx->meshes.isEmpty()) {
XA_PRINT_WARNING("AddUvMesh: Meshes and UV meshes cannot be added to the same atlas.\n");
return AddMeshError::Error;
}
#if XA_PROFILE
if (ctx->uvMeshInstances.isEmpty())
internal::s_profile.addMeshRealStart = std::chrono::high_resolution_clock::now();
#endif
XA_PROFILE_START(addMeshCopyData)
const bool hasIndices = decl.indexCount > 0;
const uint32_t indexCount = hasIndices ? decl.indexCount : decl.vertexCount;
XA_PRINT("Adding UV mesh %d: %u vertices, %u triangles\n", ctx->uvMeshes.size(), decl.vertexCount, indexCount / 3);
// Expecting triangle faces.
if ((indexCount % 3) != 0)
return AddMeshError::InvalidIndexCount;
if (hasIndices) {
// Check if any index is out of range.
for (uint32_t i = 0; i < indexCount; i++) {
const uint32_t index = DecodeIndex(decl.indexFormat, decl.indexData, decl.indexOffset, i);
if (index >= decl.vertexCount)
return AddMeshError::IndexOutOfRange;
}
}
// Create a mesh instance.
internal::UvMeshInstance *meshInstance = XA_NEW(internal::MemTag::Default, internal::UvMeshInstance);
meshInstance->mesh = nullptr;
ctx->uvMeshInstances.push_back(meshInstance);
// See if this is an instance of an already existing mesh.
internal::UvMesh *mesh = nullptr;
for (uint32_t m = 0; m < ctx->uvMeshes.size(); m++) {
if (memcmp(&ctx->uvMeshes[m]->decl, &decl, sizeof(UvMeshDecl)) == 0) {
mesh = ctx->uvMeshes[m];
XA_PRINT(" instance of a previous UV mesh\n");
break;
}
}
if (!mesh) {
// Copy geometry to mesh.
mesh = XA_NEW(internal::MemTag::Default, internal::UvMesh);
ctx->uvMeshes.push_back(mesh);
mesh->decl = decl;
if (decl.faceMaterialData) {
mesh->faceMaterials.resize(decl.indexCount / 3);
memcpy(mesh->faceMaterials.data(), decl.faceMaterialData, mesh->faceMaterials.size() * sizeof(uint32_t));
}
mesh->indices.resize(decl.indexCount);
for (uint32_t i = 0; i < indexCount; i++)
mesh->indices[i] = hasIndices ? DecodeIndex(decl.indexFormat, decl.indexData, decl.indexOffset, i) : i;
mesh->texcoords.resize(decl.vertexCount);
for (uint32_t i = 0; i < decl.vertexCount; i++)
mesh->texcoords[i] = *((const internal::Vector2 *)&((const uint8_t *)decl.vertexUvData)[decl.vertexStride * i]);
// Validate.
mesh->faceIgnore.resize(decl.indexCount / 3);
mesh->faceIgnore.zeroOutMemory();
const uint32_t kMaxWarnings = 50;
uint32_t warningCount = 0;
for (uint32_t f = 0; f < indexCount / 3; f++) {
bool ignore = false;
uint32_t tri[3];
for (uint32_t i = 0; i < 3; i++)
tri[i] = mesh->indices[f * 3 + i];
// Check for nan UVs.
for (uint32_t i = 0; i < 3; i++) {
const uint32_t vertex = tri[i];
if (internal::isNan(mesh->texcoords[vertex].x) || internal::isNan(mesh->texcoords[vertex].y)) {
ignore = true;
if (++warningCount <= kMaxWarnings)
XA_PRINT(" NAN texture coordinate in vertex %u\n", vertex);
break;
}
}
// Check for zero area faces.
if (!ignore) {
const internal::Vector2 &v1 = mesh->texcoords[tri[0]];
const internal::Vector2 &v2 = mesh->texcoords[tri[1]];
const internal::Vector2 &v3 = mesh->texcoords[tri[2]];
const float area = fabsf(((v2.x - v1.x) * (v3.y - v1.y) - (v3.x - v1.x) * (v2.y - v1.y)) * 0.5f);
if (area <= internal::kAreaEpsilon) {
ignore = true;
if (++warningCount <= kMaxWarnings)
XA_PRINT(" Zero area face: %d, indices (%d %d %d), area is %f\n", f, tri[0], tri[1], tri[2], area);
}
}
if (ignore)
mesh->faceIgnore.set(f);
}
if (warningCount > kMaxWarnings)
XA_PRINT(" %u additional warnings truncated\n", warningCount - kMaxWarnings);
}
meshInstance->mesh = mesh;
XA_PROFILE_END(addMeshCopyData)
return AddMeshError::Success;
}
void ComputeCharts(Atlas *atlas, ChartOptions options) {
if (!atlas) {
XA_PRINT_WARNING("ComputeCharts: atlas is null.\n");
return;
}
Context *ctx = (Context *)atlas;
AddMeshJoin(atlas);
if (ctx->meshes.isEmpty() && ctx->uvMeshInstances.isEmpty()) {
XA_PRINT_WARNING("ComputeCharts: No meshes. Call AddMesh or AddUvMesh first.\n");
return;
}
// Reset atlas state. This function may be called multiple times, or again after PackCharts.
if (atlas->utilization)
XA_FREE(atlas->utilization);
if (atlas->image)
XA_FREE(atlas->image);
DestroyOutputMeshes(ctx);
memset(&ctx->atlas, 0, sizeof(Atlas));
XA_PRINT("Computing charts\n");
if (!ctx->meshes.isEmpty()) {
if (!ctx->paramAtlas.computeCharts(ctx->taskScheduler, options, ctx->progressFunc, ctx->progressUserData)) {
XA_PRINT(" Cancelled by user\n");
return;
}
uint32_t chartsWithTJunctionsCount = 0, tJunctionCount = 0, orthoChartsCount = 0, planarChartsCount = 0, lscmChartsCount = 0, piecewiseChartsCount = 0, originalUvChartsCount = 0;
uint32_t chartCount = 0;
const uint32_t meshCount = ctx->meshes.size();
for (uint32_t i = 0; i < meshCount; i++) {
for (uint32_t j = 0; j < ctx->paramAtlas.chartGroupCount(i); j++) {
const internal::param::ChartGroup *chartGroup = ctx->paramAtlas.chartGroupAt(i, j);
for (uint32_t k = 0; k < chartGroup->chartCount(); k++) {
const internal::param::Chart *chart = chartGroup->chartAt(k);
tJunctionCount += chart->tjunctionCount();
if (chart->tjunctionCount() > 0)
chartsWithTJunctionsCount++;
if (chart->type() == ChartType::Ortho)
orthoChartsCount++;
else if (chart->type() == ChartType::LSCM)
lscmChartsCount++;
else if (chart->type() == ChartType::Piecewise)
piecewiseChartsCount++;
if (chart->generatorType() == internal::segment::ChartGeneratorType::OriginalUv)
originalUvChartsCount++;
}
chartCount += chartGroup->chartCount();
}
}
if (tJunctionCount > 0)
XA_PRINT(" %u t-junctions found in %u charts\n", tJunctionCount, chartsWithTJunctionsCount);
XA_PRINT(" %u charts\n", chartCount);
XA_PRINT(" %u planar, %u ortho, %u LSCM, %u piecewise\n", planarChartsCount, orthoChartsCount, lscmChartsCount, piecewiseChartsCount);
if (originalUvChartsCount > 0)
XA_PRINT(" %u with original UVs\n", originalUvChartsCount);
uint32_t chartIndex = 0, invalidParamCount = 0;
for (uint32_t i = 0; i < meshCount; i++) {
for (uint32_t j = 0; j < ctx->paramAtlas.chartGroupCount(i); j++) {
const internal::param::ChartGroup *chartGroup = ctx->paramAtlas.chartGroupAt(i, j);
for (uint32_t k = 0; k < chartGroup->chartCount(); k++) {
internal::param::Chart *chart = chartGroup->chartAt(k);
const internal::param::Quality &quality = chart->quality();
#if XA_DEBUG_EXPORT_OBJ_CHARTS_AFTER_PARAMETERIZATION
{
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_chart_%03u_after_parameterization.obj", chartIndex);
chart->unifiedMesh()->writeObjFile(filename);
}
#endif
const char *type = "LSCM";
if (chart->type() == ChartType::Ortho)
type = "ortho";
else if (chart->type() == ChartType::Piecewise)
type = "piecewise";
if (chart->isInvalid()) {
if (quality.boundaryIntersection) {
XA_PRINT_WARNING(" Chart %u (mesh %u, group %u, id %u) (%s): invalid parameterization, self-intersecting boundary.\n", chartIndex, i, j, k, type);
}
if (quality.flippedTriangleCount > 0) {
XA_PRINT_WARNING(" Chart %u (mesh %u, group %u, id %u) (%s): invalid parameterization, %u / %u flipped triangles.\n", chartIndex, i, j, k, type, quality.flippedTriangleCount, quality.totalTriangleCount);
}
if (quality.zeroAreaTriangleCount > 0) {
XA_PRINT_WARNING(" Chart %u (mesh %u, group %u, id %u) (%s): invalid parameterization, %u / %u zero area triangles.\n", chartIndex, i, j, k, type, quality.zeroAreaTriangleCount, quality.totalTriangleCount);
}
invalidParamCount++;
#if XA_DEBUG_EXPORT_OBJ_INVALID_PARAMETERIZATION
char filename[256];
XA_SPRINTF(filename, sizeof(filename), "debug_chart_%03u_invalid_parameterization.obj", chartIndex);
const internal::Mesh *mesh = chart->unifiedMesh();
FILE *file;
XA_FOPEN(file, filename, "w");
if (file) {
mesh->writeObjVertices(file);
fprintf(file, "s off\n");
fprintf(file, "o object\n");
for (uint32_t f = 0; f < mesh->faceCount(); f++)
mesh->writeObjFace(file, f);
if (!chart->paramFlippedFaces().isEmpty()) {
fprintf(file, "o flipped_faces\n");
for (uint32_t f = 0; f < chart->paramFlippedFaces().size(); f++)
mesh->writeObjFace(file, chart->paramFlippedFaces()[f]);
}
mesh->writeObjBoundaryEges(file);
fclose(file);
}
#endif
}
chartIndex++;
}
}
}
if (invalidParamCount > 0)
XA_PRINT_WARNING(" %u charts with invalid parameterizations\n", invalidParamCount);
#if XA_PROFILE
XA_PRINT(" Chart groups\n");
uint32_t chartGroupCount = 0;
for (uint32_t i = 0; i < meshCount; i++) {
#if 0
XA_PRINT(" Mesh %u: %u chart groups\n", i, ctx->paramAtlas.chartGroupCount(i));
#endif
chartGroupCount += ctx->paramAtlas.chartGroupCount(i);
}
XA_PRINT(" %u total\n", chartGroupCount);
#endif
XA_PROFILE_PRINT_AND_RESET(" Compute charts total (real): ", computeChartsReal)
XA_PROFILE_PRINT_AND_RESET(" Compute charts total (thread): ", computeChartsThread)
XA_PROFILE_PRINT_AND_RESET(" Create face groups: ", createFaceGroups)
XA_PROFILE_PRINT_AND_RESET(" Extract invalid mesh geometry: ", extractInvalidMeshGeometry)
XA_PROFILE_PRINT_AND_RESET(" Chart group compute charts (real): ", chartGroupComputeChartsReal)
XA_PROFILE_PRINT_AND_RESET(" Chart group compute charts (thread): ", chartGroupComputeChartsThread)
XA_PROFILE_PRINT_AND_RESET(" Create chart group mesh: ", createChartGroupMesh)
XA_PROFILE_PRINT_AND_RESET(" Create boundaries: ", createChartGroupMeshBoundaries)
XA_PROFILE_PRINT_AND_RESET(" Build atlas: ", buildAtlas)
XA_PROFILE_PRINT_AND_RESET(" Init: ", buildAtlasInit)
XA_PROFILE_PRINT_AND_RESET(" Planar charts: ", planarCharts)
//if (options.useInputMeshUvs) {
// XA_PROFILE_PRINT_AND_RESET(" Original UV charts: ", originalUvCharts)
//}
XA_PROFILE_PRINT_AND_RESET(" Clustered charts: ", clusteredCharts)
XA_PROFILE_PRINT_AND_RESET(" Place seeds: ", clusteredChartsPlaceSeeds)
XA_PROFILE_PRINT_AND_RESET(" Boundary intersection: ", clusteredChartsPlaceSeedsBoundaryIntersection)
XA_PROFILE_PRINT_AND_RESET(" Relocate seeds: ", clusteredChartsRelocateSeeds)
XA_PROFILE_PRINT_AND_RESET(" Reset: ", clusteredChartsReset)
XA_PROFILE_PRINT_AND_RESET(" Grow: ", clusteredChartsGrow)
XA_PROFILE_PRINT_AND_RESET(" Boundary intersection: ", clusteredChartsGrowBoundaryIntersection)
XA_PROFILE_PRINT_AND_RESET(" Merge: ", clusteredChartsMerge)
XA_PROFILE_PRINT_AND_RESET(" Fill holes: ", clusteredChartsFillHoles)
XA_PROFILE_PRINT_AND_RESET(" Copy chart faces: ", copyChartFaces)
XA_PROFILE_PRINT_AND_RESET(" Create chart mesh and parameterize (real): ", createChartMeshAndParameterizeReal)
XA_PROFILE_PRINT_AND_RESET(" Create chart mesh and parameterize (thread): ", createChartMeshAndParameterizeThread)
XA_PROFILE_PRINT_AND_RESET(" Create chart mesh: ", createChartMesh)
XA_PROFILE_PRINT_AND_RESET(" Parameterize charts: ", parameterizeCharts)
XA_PROFILE_PRINT_AND_RESET(" Orthogonal: ", parameterizeChartsOrthogonal)
XA_PROFILE_PRINT_AND_RESET(" LSCM: ", parameterizeChartsLSCM)
XA_PROFILE_PRINT_AND_RESET(" Recompute: ", parameterizeChartsRecompute)
XA_PROFILE_PRINT_AND_RESET(" Piecewise: ", parameterizeChartsPiecewise)
XA_PROFILE_PRINT_AND_RESET(" Boundary intersection: ", parameterizeChartsPiecewiseBoundaryIntersection)
XA_PROFILE_PRINT_AND_RESET(" Evaluate quality: ", parameterizeChartsEvaluateQuality)
#if XA_PROFILE_ALLOC
XA_PROFILE_PRINT_AND_RESET(" Alloc: ", alloc)
#endif
XA_PRINT_MEM_USAGE
} else {
XA_PROFILE_START(computeChartsReal)
if (!internal::segment::computeUvMeshCharts(ctx->taskScheduler, ctx->uvMeshes, ctx->progressFunc, ctx->progressUserData)) {
XA_PRINT(" Cancelled by user\n");
return;
}
XA_PROFILE_END(computeChartsReal)
ctx->uvMeshChartsComputed = true;
// Count charts.
uint32_t chartCount = 0;
const uint32_t meshCount = ctx->uvMeshes.size();
for (uint32_t i = 0; i < meshCount; i++)
chartCount += ctx->uvMeshes[i]->charts.size();
XA_PRINT(" %u charts\n", chartCount);
XA_PROFILE_PRINT_AND_RESET(" Total (real): ", computeChartsReal)
XA_PROFILE_PRINT_AND_RESET(" Total (thread): ", computeChartsThread)
}
#if XA_PROFILE_ALLOC
XA_PROFILE_PRINT_AND_RESET(" Alloc: ", alloc)
#endif
XA_PRINT_MEM_USAGE
}
void PackCharts(Atlas *atlas, PackOptions packOptions) {
// Validate arguments and context state.
if (!atlas) {
XA_PRINT_WARNING("PackCharts: atlas is null.\n");
return;
}
Context *ctx = (Context *)atlas;
if (ctx->meshes.isEmpty() && ctx->uvMeshInstances.isEmpty()) {
XA_PRINT_WARNING("PackCharts: No meshes. Call AddMesh or AddUvMesh first.\n");
return;
}
if (ctx->uvMeshInstances.isEmpty()) {
if (!ctx->paramAtlas.chartsComputed()) {
XA_PRINT_WARNING("PackCharts: ComputeCharts must be called first.\n");
return;
}
} else if (!ctx->uvMeshChartsComputed) {
XA_PRINT_WARNING("PackCharts: ComputeCharts must be called first.\n");
return;
}
if (packOptions.texelsPerUnit < 0.0f) {
XA_PRINT_WARNING("PackCharts: PackOptions::texelsPerUnit is negative.\n");
packOptions.texelsPerUnit = 0.0f;
}
// Cleanup atlas.
DestroyOutputMeshes(ctx);
if (atlas->utilization) {
XA_FREE(atlas->utilization);
atlas->utilization = nullptr;
}
if (atlas->image) {
XA_FREE(atlas->image);
atlas->image = nullptr;
}
atlas->meshCount = 0;
// Pack charts.
XA_PROFILE_START(packChartsAddCharts)
internal::pack::Atlas packAtlas;
if (!ctx->uvMeshInstances.isEmpty()) {
for (uint32_t i = 0; i < ctx->uvMeshInstances.size(); i++)
packAtlas.addUvMeshCharts(ctx->uvMeshInstances[i]);
} else
packAtlas.addCharts(ctx->taskScheduler, &ctx->paramAtlas);
XA_PROFILE_END(packChartsAddCharts)
XA_PROFILE_START(packCharts)
if (!packAtlas.packCharts(packOptions, ctx->progressFunc, ctx->progressUserData))
return;
XA_PROFILE_END(packCharts)
// Populate atlas object with pack results.
atlas->atlasCount = packAtlas.getNumAtlases();
atlas->chartCount = packAtlas.getChartCount();
atlas->width = packAtlas.getWidth();
atlas->height = packAtlas.getHeight();
atlas->texelsPerUnit = packAtlas.getTexelsPerUnit();
if (atlas->atlasCount > 0) {
atlas->utilization = XA_ALLOC_ARRAY(internal::MemTag::Default, float, atlas->atlasCount);
for (uint32_t i = 0; i < atlas->atlasCount; i++)
atlas->utilization[i] = packAtlas.getUtilization(i);
}
if (packOptions.createImage) {
atlas->image = XA_ALLOC_ARRAY(internal::MemTag::Default, uint32_t, atlas->atlasCount * atlas->width * atlas->height);
for (uint32_t i = 0; i < atlas->atlasCount; i++)
packAtlas.getImages()[i]->copyTo(&atlas->image[atlas->width * atlas->height * i], atlas->width, atlas->height, packOptions.padding);
}
XA_PROFILE_PRINT_AND_RESET(" Total: ", packCharts)
XA_PROFILE_PRINT_AND_RESET(" Add charts (real): ", packChartsAddCharts)
XA_PROFILE_PRINT_AND_RESET(" Add charts (thread): ", packChartsAddChartsThread)
XA_PROFILE_PRINT_AND_RESET(" Restore texcoords: ", packChartsAddChartsRestoreTexcoords)
XA_PROFILE_PRINT_AND_RESET(" Rasterize: ", packChartsRasterize)
XA_PROFILE_PRINT_AND_RESET(" Dilate (padding): ", packChartsDilate)
XA_PROFILE_PRINT_AND_RESET(" Find location: ", packChartsFindLocation)
XA_PROFILE_PRINT_AND_RESET(" Blit: ", packChartsBlit)
#if XA_PROFILE_ALLOC
XA_PROFILE_PRINT_AND_RESET(" Alloc: ", alloc)
#endif
XA_PRINT_MEM_USAGE
XA_PRINT("Building output meshes\n");
XA_PROFILE_START(buildOutputMeshes)
int progress = 0;
if (ctx->progressFunc) {
if (!ctx->progressFunc(ProgressCategory::BuildOutputMeshes, 0, ctx->progressUserData))
return;
}
if (ctx->uvMeshInstances.isEmpty())
atlas->meshCount = ctx->meshes.size();
else
atlas->meshCount = ctx->uvMeshInstances.size();
atlas->meshes = XA_ALLOC_ARRAY(internal::MemTag::Default, Mesh, atlas->meshCount);
memset(atlas->meshes, 0, sizeof(Mesh) * atlas->meshCount);
if (ctx->uvMeshInstances.isEmpty()) {
uint32_t chartIndex = 0;
for (uint32_t i = 0; i < atlas->meshCount; i++) {
Mesh &outputMesh = atlas->meshes[i];
MeshPolygonMapping *meshPolygonMapping = ctx->meshPolygonMappings[i];
// One polygon can have many triangles. Don't want to process the same polygon more than once when counting indices, building chart faces etc.
internal::BitArray polygonTouched;
if (meshPolygonMapping) {
polygonTouched.resize(meshPolygonMapping->faceVertexCount.size());
polygonTouched.zeroOutMemory();
}
// Count and alloc arrays.
const internal::InvalidMeshGeometry &invalid = ctx->paramAtlas.invalidMeshGeometry(i);
outputMesh.vertexCount += invalid.vertices().length;
outputMesh.indexCount += invalid.faces().length * 3;
for (uint32_t cg = 0; cg < ctx->paramAtlas.chartGroupCount(i); cg++) {
const internal::param::ChartGroup *chartGroup = ctx->paramAtlas.chartGroupAt(i, cg);
for (uint32_t c = 0; c < chartGroup->chartCount(); c++) {
const internal::param::Chart *chart = chartGroup->chartAt(c);
outputMesh.vertexCount += chart->originalVertexCount();
const uint32_t faceCount = chart->unifiedMesh()->faceCount();
if (meshPolygonMapping) {
// Map triangles back to polygons and count the polygon vertices.
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t polygon = meshPolygonMapping->triangleToPolygonMap[chart->mapFaceToSourceFace(f)];
if (!polygonTouched.get(polygon)) {
polygonTouched.set(polygon);
outputMesh.indexCount += meshPolygonMapping->faceVertexCount[polygon];
}
}
} else {
outputMesh.indexCount += faceCount * 3;
}
outputMesh.chartCount++;
}
}
outputMesh.vertexArray = XA_ALLOC_ARRAY(internal::MemTag::Default, Vertex, outputMesh.vertexCount);
outputMesh.indexArray = XA_ALLOC_ARRAY(internal::MemTag::Default, uint32_t, outputMesh.indexCount);
outputMesh.chartArray = XA_ALLOC_ARRAY(internal::MemTag::Default, Chart, outputMesh.chartCount);
XA_PRINT(" Mesh %u: %u vertices, %u triangles, %u charts\n", i, outputMesh.vertexCount, outputMesh.indexCount / 3, outputMesh.chartCount);
// Copy mesh data.
uint32_t firstVertex = 0;
{
const internal::InvalidMeshGeometry &mesh = ctx->paramAtlas.invalidMeshGeometry(i);
internal::ConstArrayView<uint32_t> faces = mesh.faces();
internal::ConstArrayView<uint32_t> indices = mesh.indices();
internal::ConstArrayView<uint32_t> vertices = mesh.vertices();
// Vertices.
for (uint32_t v = 0; v < vertices.length; v++) {
Vertex &vertex = outputMesh.vertexArray[v];
vertex.atlasIndex = -1;
vertex.chartIndex = -1;
vertex.uv[0] = vertex.uv[1] = 0.0f;
vertex.xref = vertices[v];
}
// Indices.
for (uint32_t f = 0; f < faces.length; f++) {
const uint32_t indexOffset = faces[f] * 3;
for (uint32_t j = 0; j < 3; j++)
outputMesh.indexArray[indexOffset + j] = indices[f * 3 + j];
}
firstVertex = vertices.length;
}
uint32_t meshChartIndex = 0;
for (uint32_t cg = 0; cg < ctx->paramAtlas.chartGroupCount(i); cg++) {
const internal::param::ChartGroup *chartGroup = ctx->paramAtlas.chartGroupAt(i, cg);
for (uint32_t c = 0; c < chartGroup->chartCount(); c++) {
const internal::param::Chart *chart = chartGroup->chartAt(c);
const internal::Mesh *unifiedMesh = chart->unifiedMesh();
const uint32_t faceCount = unifiedMesh->faceCount();
#if XA_CHECK_PARAM_WINDING
uint32_t flippedCount = 0;
for (uint32_t f = 0; f < faceCount; f++) {
const float area = mesh->computeFaceParametricArea(f);
if (area < 0.0f)
flippedCount++;
}
const char *type = "LSCM";
if (chart->type() == ChartType::Planar)
type = "planar";
else if (chart->type() == ChartType::Ortho)
type = "ortho";
else if (chart->type() == ChartType::Piecewise)
type = "piecewise";
if (flippedCount > 0) {
if (flippedCount == faceCount) {
XA_PRINT_WARNING("chart %u (%s): all face flipped\n", chartIndex, type);
} else {
XA_PRINT_WARNING("chart %u (%s): %u / %u faces flipped\n", chartIndex, type, flippedCount, faceCount);
}
}
#endif
// Vertices.
for (uint32_t v = 0; v < chart->originalVertexCount(); v++) {
Vertex &vertex = outputMesh.vertexArray[firstVertex + v];
vertex.atlasIndex = packAtlas.getChart(chartIndex)->atlasIndex;
XA_DEBUG_ASSERT(vertex.atlasIndex >= 0);
vertex.chartIndex = (int32_t)chartIndex;
const internal::Vector2 &uv = unifiedMesh->texcoord(chart->originalVertexToUnifiedVertex(v));
vertex.uv[0] = internal::max(0.0f, uv.x);
vertex.uv[1] = internal::max(0.0f, uv.y);
vertex.xref = chart->mapChartVertexToSourceVertex(v);
}
// Indices.
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t indexOffset = chart->mapFaceToSourceFace(f) * 3;
for (uint32_t j = 0; j < 3; j++) {
uint32_t outIndex = indexOffset + j;
if (meshPolygonMapping)
outIndex = meshPolygonMapping->triangleToPolygonIndicesMap[outIndex];
outputMesh.indexArray[outIndex] = firstVertex + chart->originalVertices()[f * 3 + j];
}
}
// Charts.
Chart *outputChart = &outputMesh.chartArray[meshChartIndex];
const int32_t atlasIndex = packAtlas.getChart(chartIndex)->atlasIndex;
XA_DEBUG_ASSERT(atlasIndex >= 0);
outputChart->atlasIndex = (uint32_t)atlasIndex;
outputChart->type = chart->isInvalid() ? ChartType::Invalid : chart->type();
if (meshPolygonMapping) {
// Count polygons.
polygonTouched.zeroOutMemory();
outputChart->faceCount = 0;
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t polygon = meshPolygonMapping->triangleToPolygonMap[chart->mapFaceToSourceFace(f)];
if (!polygonTouched.get(polygon)) {
polygonTouched.set(polygon);
outputChart->faceCount++;
}
}
// Write polygons.
outputChart->faceArray = XA_ALLOC_ARRAY(internal::MemTag::Default, uint32_t, outputChart->faceCount);
polygonTouched.zeroOutMemory();
uint32_t of = 0;
for (uint32_t f = 0; f < faceCount; f++) {
const uint32_t polygon = meshPolygonMapping->triangleToPolygonMap[chart->mapFaceToSourceFace(f)];
if (!polygonTouched.get(polygon)) {
polygonTouched.set(polygon);
outputChart->faceArray[of++] = polygon;
}
}
} else {
outputChart->faceCount = faceCount;
outputChart->faceArray = XA_ALLOC_ARRAY(internal::MemTag::Default, uint32_t, outputChart->faceCount);
for (uint32_t f = 0; f < outputChart->faceCount; f++)
outputChart->faceArray[f] = chart->mapFaceToSourceFace(f);
}
outputChart->material = 0;
meshChartIndex++;
chartIndex++;
firstVertex += chart->originalVertexCount();
}
}
XA_DEBUG_ASSERT(outputMesh.vertexCount == firstVertex);
XA_DEBUG_ASSERT(outputMesh.chartCount == meshChartIndex);
if (ctx->progressFunc) {
const int newProgress = int((i + 1) / (float)atlas->meshCount * 100.0f);
if (newProgress != progress) {
progress = newProgress;
if (!ctx->progressFunc(ProgressCategory::BuildOutputMeshes, progress, ctx->progressUserData))
return;
}
}
}
} else {
uint32_t chartIndex = 0;
for (uint32_t m = 0; m < ctx->uvMeshInstances.size(); m++) {
Mesh &outputMesh = atlas->meshes[m];
const internal::UvMeshInstance *mesh = ctx->uvMeshInstances[m];
// Alloc arrays.
outputMesh.vertexCount = mesh->texcoords.size();
outputMesh.indexCount = mesh->mesh->indices.size();
outputMesh.chartCount = mesh->mesh->charts.size();
outputMesh.vertexArray = XA_ALLOC_ARRAY(internal::MemTag::Default, Vertex, outputMesh.vertexCount);
outputMesh.indexArray = XA_ALLOC_ARRAY(internal::MemTag::Default, uint32_t, outputMesh.indexCount);
outputMesh.chartArray = XA_ALLOC_ARRAY(internal::MemTag::Default, Chart, outputMesh.chartCount);
XA_PRINT(" UV mesh %u: %u vertices, %u triangles, %u charts\n", m, outputMesh.vertexCount, outputMesh.indexCount / 3, outputMesh.chartCount);
// Copy mesh data.
// Vertices.
for (uint32_t v = 0; v < mesh->texcoords.size(); v++) {
Vertex &vertex = outputMesh.vertexArray[v];
vertex.uv[0] = mesh->texcoords[v].x;
vertex.uv[1] = mesh->texcoords[v].y;
vertex.xref = v;
const uint32_t meshChartIndex = mesh->mesh->vertexToChartMap[v];
if (meshChartIndex == UINT32_MAX) {
// Vertex doesn't exist in any chart.
vertex.atlasIndex = -1;
vertex.chartIndex = -1;
} else {
const internal::pack::Chart *chart = packAtlas.getChart(chartIndex + meshChartIndex);
vertex.atlasIndex = chart->atlasIndex;
vertex.chartIndex = (int32_t)chartIndex + meshChartIndex;
}
}
// Indices.
memcpy(outputMesh.indexArray, mesh->mesh->indices.data(), mesh->mesh->indices.size() * sizeof(uint32_t));
// Charts.
for (uint32_t c = 0; c < mesh->mesh->charts.size(); c++) {
Chart *outputChart = &outputMesh.chartArray[c];
const internal::pack::Chart *chart = packAtlas.getChart(chartIndex);
XA_DEBUG_ASSERT(chart->atlasIndex >= 0);
outputChart->atlasIndex = (uint32_t)chart->atlasIndex;
outputChart->faceCount = chart->faces.size();
outputChart->faceArray = XA_ALLOC_ARRAY(internal::MemTag::Default, uint32_t, outputChart->faceCount);
outputChart->material = chart->material;
for (uint32_t f = 0; f < outputChart->faceCount; f++)
outputChart->faceArray[f] = chart->faces[f];
chartIndex++;
}
if (ctx->progressFunc) {
const int newProgress = int((m + 1) / (float)atlas->meshCount * 100.0f);
if (newProgress != progress) {
progress = newProgress;
if (!ctx->progressFunc(ProgressCategory::BuildOutputMeshes, progress, ctx->progressUserData))
return;
}
}
}
}
if (ctx->progressFunc && progress != 100)
ctx->progressFunc(ProgressCategory::BuildOutputMeshes, 100, ctx->progressUserData);
XA_PROFILE_END(buildOutputMeshes)
XA_PROFILE_PRINT_AND_RESET(" Total: ", buildOutputMeshes)
#if XA_PROFILE_ALLOC
XA_PROFILE_PRINT_AND_RESET(" Alloc: ", alloc)
#endif
XA_PRINT_MEM_USAGE
}
void Generate(Atlas *atlas, ChartOptions chartOptions, PackOptions packOptions) {
if (!atlas) {
XA_PRINT_WARNING("Generate: atlas is null.\n");
return;
}
Context *ctx = (Context *)atlas;
if (ctx->meshes.isEmpty() && ctx->uvMeshInstances.isEmpty()) {
XA_PRINT_WARNING("Generate: No meshes. Call AddMesh or AddUvMesh first.\n");
return;
}
ComputeCharts(atlas, chartOptions);
PackCharts(atlas, packOptions);
}
void SetProgressCallback(Atlas *atlas, ProgressFunc progressFunc, void *progressUserData) {
if (!atlas) {
XA_PRINT_WARNING("SetProgressCallback: atlas is null.\n");
return;
}
Context *ctx = (Context *)atlas;
ctx->progressFunc = progressFunc;
ctx->progressUserData = progressUserData;
}
void SetAlloc(ReallocFunc reallocFunc, FreeFunc freeFunc) {
internal::s_realloc = reallocFunc;
internal::s_free = freeFunc;
}
void SetPrint(PrintFunc print, bool verbose) {
internal::s_print = print;
internal::s_printVerbose = verbose;
}
const char *StringForEnum(AddMeshError error) {
if (error == AddMeshError::Error)
return "Unspecified error";
if (error == AddMeshError::IndexOutOfRange)
return "Index out of range";
if (error == AddMeshError::InvalidFaceVertexCount)
return "Invalid face vertex count";
if (error == AddMeshError::InvalidIndexCount)
return "Invalid index count";
return "Success";
}
const char *StringForEnum(ProgressCategory category) {
if (category == ProgressCategory::AddMesh)
return "Adding mesh(es)";
if (category == ProgressCategory::ComputeCharts)
return "Computing charts";
if (category == ProgressCategory::PackCharts)
return "Packing charts";
if (category == ProgressCategory::BuildOutputMeshes)
return "Building output meshes";
return "";
}
} //namespace xatlas_mu
#if XATLAS_C_API
static_assert(sizeof(xatlas_mu::Chart) == sizeof(xatlasChart), "xatlasChart size mismatch");
static_assert(sizeof(xatlas_mu::Vertex) == sizeof(xatlasVertex), "xatlasVertex size mismatch");
static_assert(sizeof(xatlas_mu::Mesh) == sizeof(xatlasMesh), "xatlasMesh size mismatch");
static_assert(sizeof(xatlas_mu::Atlas) == sizeof(xatlasAtlas), "xatlasAtlas size mismatch");
static_assert(sizeof(xatlas_mu::MeshDecl) == sizeof(xatlasMeshDecl), "xatlasMeshDecl size mismatch");
static_assert(sizeof(xatlas_mu::UvMeshDecl) == sizeof(xatlasUvMeshDecl), "xatlasUvMeshDecl size mismatch");
static_assert(sizeof(xatlas_mu::ChartOptions) == sizeof(xatlasChartOptions), "xatlasChartOptions size mismatch");
static_assert(sizeof(xatlas_mu::PackOptions) == sizeof(xatlasPackOptions), "xatlasPackOptions size mismatch");
#ifdef __cplusplus
extern "C" {
#endif
xatlasAtlas *xatlasCreate() {
return (xatlasAtlas *)xatlas_mu::Create();
}
void xatlasDestroy(xatlasAtlas *atlas) {
xatlas_mu::Destroy((xatlas_mu::Atlas *)atlas);
}
xatlasAddMeshError xatlasAddMesh(xatlasAtlas *atlas, const xatlasMeshDecl *meshDecl, uint32_t meshCountHint) {
return (xatlasAddMeshError)xatlas_mu::AddMesh((xatlas_mu::Atlas *)atlas, *(const xatlas_mu::MeshDecl *)meshDecl, meshCountHint);
}
void xatlasAddMeshJoin(xatlasAtlas *atlas) {
xatlas_mu::AddMeshJoin((xatlas_mu::Atlas *)atlas);
}
xatlasAddMeshError xatlasAddUvMesh(xatlasAtlas *atlas, const xatlasUvMeshDecl *decl) {
return (xatlasAddMeshError)xatlas_mu::AddUvMesh((xatlas_mu::Atlas *)atlas, *(const xatlas_mu::UvMeshDecl *)decl);
}
void xatlasComputeCharts(xatlasAtlas *atlas, const xatlasChartOptions *chartOptions) {
xatlas_mu::ComputeCharts((xatlas_mu::Atlas *)atlas, chartOptions ? *(xatlas_mu::ChartOptions *)chartOptions : xatlas_mu::ChartOptions());
}
void xatlasPackCharts(xatlasAtlas *atlas, const xatlasPackOptions *packOptions) {
xatlas_mu::PackCharts((xatlas_mu::Atlas *)atlas, packOptions ? *(xatlas_mu::PackOptions *)packOptions : xatlas_mu::PackOptions());
}
void xatlasGenerate(xatlasAtlas *atlas, const xatlasChartOptions *chartOptions, const xatlasPackOptions *packOptions) {
xatlas_mu::Generate((xatlas_mu::Atlas *)atlas, chartOptions ? *(xatlas_mu::ChartOptions *)chartOptions : xatlas_mu::ChartOptions(), packOptions ? *(xatlas_mu::PackOptions *)packOptions : xatlas_mu::PackOptions());
}
void xatlasSetProgressCallback(xatlasAtlas *atlas, xatlasProgressFunc progressFunc, void *progressUserData) {
xatlas_mu::ProgressFunc pf;
*(void **)&pf = (void *)progressFunc;
xatlas_mu::SetProgressCallback((xatlas_mu::Atlas *)atlas, pf, progressUserData);
}
void xatlasSetAlloc(xatlasReallocFunc reallocFunc, xatlasFreeFunc freeFunc) {
xatlas_mu::SetAlloc((xatlas_mu::ReallocFunc)reallocFunc, (xatlas_mu::FreeFunc)freeFunc);
}
void xatlasSetPrint(xatlasPrintFunc print, bool verbose) {
xatlas_mu::SetPrint((xatlas_mu::PrintFunc)print, verbose);
}
const char *xatlasAddMeshErrorString(xatlasAddMeshError error) {
return xatlas_mu::StringForEnum((xatlas_mu::AddMeshError)error);
}
const char *xatlasProgressCategoryString(xatlasProgressCategory category) {
return xatlas_mu::StringForEnum((xatlas_mu::ProgressCategory)category);
}
void xatlasMeshDeclInit(xatlasMeshDecl *meshDecl) {
xatlas_mu::MeshDecl init;
memcpy(meshDecl, &init, sizeof(init));
}
void xatlasUvMeshDeclInit(xatlasUvMeshDecl *uvMeshDecl) {
xatlas_mu::UvMeshDecl init;
memcpy(uvMeshDecl, &init, sizeof(init));
}
void xatlasChartOptionsInit(xatlasChartOptions *chartOptions) {
xatlas_mu::ChartOptions init;
memcpy(chartOptions, &init, sizeof(init));
}
void xatlasPackOptionsInit(xatlasPackOptions *packOptions) {
xatlas_mu::PackOptions init;
memcpy(packOptions, &init, sizeof(init));
}
#ifdef __cplusplus
} // extern "C"
#endif
#endif // XATLAS_C_API
Reference in New Issue View Git Blame Copy Permalink