182 {
183 uint16_t n =
xyMap.getTotal();
184 uint16_t outputWidth =
xyMap.getWidth();
185 uint16_t outputHeight =
xyMap.getHeight();
186
187 for (uint16_t
y = 0;
y < outputHeight;
y++) {
188 for (uint16_t
x = 0;
x < outputWidth;
x++) {
189
190 float fx =
static_cast<float>(
x) * (inputWidth - 1) / (outputWidth - 1);
191 float fy =
static_cast<float>(
y) * (inputHeight - 1) / (outputHeight - 1);
192
193 uint16_t ix = static_cast<uint16_t>(fx);
194 uint16_t iy = static_cast<uint16_t>(fy);
195 float dx = fx - ix;
196 float dy = fy - iy;
197
198 uint16_t ix1 = (ix + 1 < inputWidth) ? ix + 1 : ix;
199 uint16_t iy1 = (iy + 1 < inputHeight) ? iy + 1 : iy;
200
201 uint16_t i00 = iy * inputWidth + ix;
202 uint16_t i10 = iy * inputWidth + ix1;
203 uint16_t i01 = iy1 * inputWidth + ix;
204 uint16_t i11 = iy1 * inputWidth + ix1;
205
206 CRGB c00 = input[i00];
207 CRGB c10 = input[i10];
208 CRGB c01 = input[i01];
209 CRGB c11 = input[i11];
210
215
216 uint16_t idx =
xyMap.mapToIndex(
x,
y);
217 if (idx < n) {
218 output[idx] = result;
219 }
220 }
221 }
222}
XYMap xyMap(HEIGHT, WIDTH, SERPENTINE)
uint8_t bilinearInterpolateFloat(uint8_t v00, uint8_t v10, uint8_t v01, uint8_t v11, float dx, float dy)
Representation of an RGB pixel (Red, Green, Blue)