The inverse of TransferModuleAdjustMultipixels: a raw pixel is the sum of the 2 (multipixel) or 4 (chip corner) assembled pixels its value was split over, as the split conserves the count; an error pixel among them makes it an error pixel, a saturated one or a sum past the destination's range a saturated one. ConvertedToRawGeometry takes one of them instead, which is right for masks and maps but halves the counts of the split pixels. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_01UqXYdHHZ4cogS1mrGUtfN7
214 lines
9.4 KiB
C++
214 lines
9.4 KiB
C++
// SPDX-FileCopyrightText: 2024 Filip Leonarski, Paul Scherrer Institute <filip.leonarski@psi.ch>
|
|
// SPDX-License-Identifier: GPL-3.0-only
|
|
|
|
#pragma once
|
|
|
|
#include <cstdint>
|
|
#include <cstddef>
|
|
#include "Definitions.h"
|
|
|
|
// Take half of the number, but only if not bad pixel/overload
|
|
template<typename T>
|
|
T half(T in, T min, T max) {
|
|
T tmp = in;
|
|
if ((in > min) && (in < max)) tmp /= 2;
|
|
return tmp;
|
|
}
|
|
|
|
template<typename T>
|
|
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<typename Td, typename Ts>
|
|
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<typename Td, typename Ts>
|
|
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<typename Td, typename Ts>
|
|
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<class T, class Tint = int32_t>
|
|
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<T>(sum);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
template<class T, class Tint = int32_t>
|
|
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<T, Tint>(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<class Td, class Ts>
|
|
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<Td, Ts>(destination + slow_dir_step * (line + 1),
|
|
source + RAW_MODULE_COLS * line,
|
|
fast_dir_step, offset_0);
|
|
LineCopyAndAddMultipixel<Td, Ts>(destination + slow_dir_step * (line + ((line > 255) ? 2 : 0)),
|
|
source + RAW_MODULE_COLS * line,
|
|
fast_dir_step, offset_0);
|
|
} else {
|
|
LineCopyAndAddMultipixel<Td, Ts>(destination + slow_dir_step * (line + ((line > 255) ? 2 : 0)),
|
|
source + RAW_MODULE_COLS * line,
|
|
fast_dir_step);
|
|
}
|
|
}
|
|
}
|
|
|
|
template<class Td, class Ts>
|
|
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<Td, Ts>(destination + slow_dir_step * (line + ((line > 255) ? 2 : 0)),
|
|
source + RAW_MODULE_COLS * line, min, max, fast_dir_step,
|
|
offset_0);
|
|
else {
|
|
LineCopyAndAdjustMultipixelMidRow<Td, Ts>(destination + slow_dir_step * (line + ((line > 255) ? 2 : 0)),
|
|
source + RAW_MODULE_COLS * line, min, max,
|
|
fast_dir_step, offset_0);
|
|
LineCopyAndAdjustMultipixelMidRow<Td, Ts>(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<class Td, class Ts>
|
|
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<Td>(sum);
|
|
}
|
|
}
|
|
}
|
|
|
|
template<class T>
|
|
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<class T>
|
|
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];
|
|
}
|
|
}
|
|
}
|