// SPDX-FileCopyrightText: 2024 Filip Leonarski, Paul Scherrer Institute // SPDX-License-Identifier: GPL-3.0-only #pragma once #include #include #include "Definitions.h" // Take half of the number, but only if not bad pixel/overload template T half(T in, T min, T max) { T tmp = in; if ((in > min) && (in < max)) tmp /= 2; return tmp; } template T quarter(T in, T min, T max) { T tmp = in; if ((in > min) && (in < max)) tmp /= 4; return tmp; } // Copy line, divide everything by 2 and extend multipixels + divide them by additional factor of 2 template void LineCopyAndAdjustMultipixelMidRow(Td *destination, const Ts *source, Ts min, Ts max, int64_t fast_dir_step = 1, int64_t offset_0 = 0) { for (int chip = 0; chip < 4; chip++) { for (int i = 0; i < 256; i++) { destination[offset_0 + (i + chip * 258) * fast_dir_step] = half(source[i + chip * 256], min, max); } } for (int i = 0; i < 3; i++) { destination[offset_0 + (255 + i * 258) * fast_dir_step] = quarter(source[255 + i * 256], min, max); destination[offset_0 + (256 + i * 258) * fast_dir_step] = quarter(source[255 + i * 256], min, max); destination[offset_0 + (257 + i * 258) * fast_dir_step] = quarter(source[256 + i * 256], min, max); destination[offset_0 + (258 + i * 258) * fast_dir_step] = quarter(source[256 + i * 256], min, max); } } // Copy line and extend multipixels + divide them by 2 template void LineCopyAndAdjustMultipixel(Td *destination, const Ts *source, Ts min, Ts max, int64_t fast_dir_step = 1, int64_t offset_0 = 0) { for (int chip = 0; chip < 4; chip++) { for (int i = 0; i < 256; i++) { destination[offset_0 + (i + chip * 258) * fast_dir_step] = source[i + chip * 256]; } } for (int chip = 0; chip < 3; chip++) { destination[offset_0 + (255 + chip * 258) * fast_dir_step] = half(source[255 + chip * 256], min, max); destination[offset_0 + (256 + chip * 258) * fast_dir_step] = half(source[255 + chip * 256], min, max); destination[offset_0 + (257 + chip * 258) * fast_dir_step] = half(source[256 + chip * 256], min, max); destination[offset_0 + (258 + chip * 258) * fast_dir_step] = half(source[256 + chip * 256], min, max); } } // Copy line and copy multipixels (e.g. for mask) template void LineCopyAndAddMultipixel(Td *destination, const Ts *source, int64_t fast_dir_step = 1, int64_t offset_0 = 0) { for (int chip = 0; chip < 4; chip++) { for (int i = 0; i < 256; i++) destination[offset_0 + (i + chip * 258) * fast_dir_step] = source[i + chip * 256]; } for (int i = 0; i < 3; i++) { destination[offset_0 + (256 + i * 258) * fast_dir_step] = source[255 + i * 256]; destination[offset_0 + (257 + i * 258) * fast_dir_step] = source[256 + i * 256]; } } template T Bin2x2_sum(T a, T b, T c, T d, T underload, T overload) { T ret; if ((a <= underload) || (b <= underload) || (c <= underload) || (d <= underload)) ret = underload; else if ((a >= overload) || (b >= overload) || (c >= overload) || (d >= overload)) ret = overload; else { Tint sum = a + b + c + d; if (sum > overload) ret = overload; else ret = static_cast(sum); } return ret; } template void Bin2x2_sum(T *destination, const T *source, size_t width, size_t height, T underload, T overload) { for (int y = 0; y < height / 2; y++) { for (int x = 0; x < width / 2; x++) destination[y * (width / 2) + x] = Bin2x2_sum(source[(y * 2) * width + (x * 2)], source[(y * 2 + 1) * width + (x * 2)], source[(y * 2) * width + (x * 2 + 1)], source[(y * 2 + 1) * width + (x * 2 + 1)], underload, overload); } } template void TransferModule(Td *destination, const Ts *source, int64_t slow_dir_step, int64_t fast_dir_step = 1, int64_t offset_0 = 0) { for (size_t line = 0; line < RAW_MODULE_LINES; line++) { if ((line == 255) || (line == 256)) { LineCopyAndAddMultipixel(destination + slow_dir_step * (line + 1), source + RAW_MODULE_COLS * line, fast_dir_step, offset_0); LineCopyAndAddMultipixel(destination + slow_dir_step * (line + ((line > 255) ? 2 : 0)), source + RAW_MODULE_COLS * line, fast_dir_step, offset_0); } else { LineCopyAndAddMultipixel(destination + slow_dir_step * (line + ((line > 255) ? 2 : 0)), source + RAW_MODULE_COLS * line, fast_dir_step); } } } template void TransferModuleAdjustMultipixels(Td *destination, const Ts *source, int64_t slow_dir_step, Ts min, Ts max, int64_t fast_dir_step = 1, int64_t offset_0 = 0) { for (size_t line = 0; line < RAW_MODULE_LINES; line++) { if ((line != 255) && (line != 256)) LineCopyAndAdjustMultipixel(destination + slow_dir_step * (line + ((line > 255) ? 2 : 0)), source + RAW_MODULE_COLS * line, min, max, fast_dir_step, offset_0); else { LineCopyAndAdjustMultipixelMidRow(destination + slow_dir_step * (line + ((line > 255) ? 2 : 0)), source + RAW_MODULE_COLS * line, min, max, fast_dir_step, offset_0); LineCopyAndAdjustMultipixelMidRow(destination + slow_dir_step * (line + 1), source + RAW_MODULE_COLS * line, min, max, fast_dir_step, offset_0); } } } // Inverse of TransferModuleAdjustMultipixels: each raw pixel of the module is the sum of the pixels its value was // split over (2 for a multipixel, 4 at a chip corner), as the split conserves the count. A raw pixel is an error // pixel where any of them is at or below min, saturated where any is at or above max or the sum reaches dest_max. template void SqueezeMultipixelsToModule(Td *destination, const Ts *source, int64_t slow_dir_step, Ts min, Ts max, Td dest_min, Td dest_max, int64_t fast_dir_step = 1, int64_t offset_0 = 0) { for (int64_t line = 0; line < RAW_MODULE_LINES; line++) { int64_t y[2] = {line + ((line > 255) ? 2 : 0), -1}; if (line == 255) y[1] = 256; else if (line == 256) y[1] = 257; for (int64_t col = 0; col < RAW_MODULE_COLS; col++) { const int64_t chip = col / 256, i = col % 256; int64_t x[2] = {i + chip * 258, -1}; if ((i == 255) && (chip < 3)) x[1] = x[0] + 1; else if ((i == 0) && (chip > 0)) x[1] = x[0] - 1; int64_t sum = 0; bool error = false, saturated = false; for (int64_t yy: y) { for (int64_t xx: x) { if ((yy < 0) || (xx < 0)) continue; const Ts v = source[offset_0 + yy * slow_dir_step + xx * fast_dir_step]; if (v <= min) error = true; else if (v >= max) saturated = true; else sum += v; } } Td &out = destination[line * RAW_MODULE_COLS + col]; if (error) out = dest_min; else if (saturated || (sum >= dest_max)) out = dest_max; else if (sum <= dest_min) out = dest_min + 1; else out = static_cast(sum); } } } template void LineConvtToRaw(T *destination, const T *source, size_t fast_direction_step) { for (int chip = 0; chip < 4; chip++) { for (int i = 0; i < 256; i++) destination[i + chip * 256] = source[(i + chip * 258) * fast_direction_step]; } } template void Bin2x2_or(T *destination, const T *source, size_t width, size_t height) { for (int y = 0; y < height / 2; y++) { for (int x = 0; x < width / 2; x++) { T tmp[4]; tmp[0] = source[(y * 2) * width + (x * 2)]; tmp[1] = source[(y * 2 + 1) * width + (x * 2)]; tmp[2] = source[(y * 2) * width + (x * 2 + 1)]; tmp[3] = source[(y * 2 + 1) * width + (x * 2 + 1)]; destination[y * (width / 2) + x] = tmp[0] | tmp[1] | tmp[2] | tmp[3]; } } }