317 {
318 u8 outputWidth =
xyMap.getWidth();
319 u8 outputHeight =
xyMap.getHeight();
320 if (outputWidth !=
xyMap.getWidth() || outputHeight !=
xyMap.getHeight()) {
321
322 return;
323 }
324 u16 n =
xyMap.getTotal();
325
326 for (
u8 y = 0;
y < outputHeight;
y++) {
327 for (
u8 x = 0;
x < outputWidth;
x++) {
328
329 float fx =
330 static_cast<float>(
x) * (inputWidth - 1) / (outputWidth - 1);
331 float fy =
332 static_cast<float>(
y) * (inputHeight - 1) / (outputHeight - 1);
333
334 u8 ix =
static_cast<u8>(fx);
335 u8 iy =
static_cast<u8>(fy);
336 float dx = fx - ix;
337 float dy = fy - iy;
338
339 u8 ix1 = (ix + 1 < inputWidth) ? ix + 1 : ix;
340 u8 iy1 = (iy + 1 < inputHeight) ? iy + 1 : iy;
341
342 u16 i00 = iy * inputWidth + ix;
343 u16 i10 = iy * inputWidth + ix1;
344 u16 i01 = iy1 * inputWidth + ix;
345 u16 i11 = iy1 * inputWidth + ix1;
346
347 CRGB c00 = input[i00];
348 CRGB c10 = input[i10];
349 CRGB c01 = input[i01];
350 CRGB c11 = input[i11];
351
353 result.r =
355 result.g =
357 result.b =
359
360 u16 idx =
xyMap.mapToIndex(
x,
y);
361 if (idx < n) {
362 output[idx] = result;
363 }
364 }
365 }
366}
u8 upscaleFloat(u8 v00, u8 v10, u8 v01, u8 v11, float dx, float dy)
Representation of an RGB pixel (Red, Green, Blue)