1use crate::agx::{AgxConfig, AgxPipeline, Gamut, OutputTransfer, Transfer};
2use crate::file::BayerPattern;
3use anyhow::Result;
4use rayon::prelude::*;
5
6pub trait Demosaic {
7 fn process(&self, bayer: &[u16], stride_width: u32, offset_x: u32, offset_y: u32, active_width: u32, active_height: u32, pattern: &BayerPattern) -> Result<Vec<f32>>;
8}
9
10pub trait ColorSpaceConverter {
11 fn process(&self, pixels: &mut [f32], ccm: &[f32; 9]);
12}
13
14pub trait TransferFunctionProcessor {
15 fn process(&self, pixels: &mut [f32]);
16}
17
18#[derive(Debug, Clone, Copy, PartialEq, Eq)]
19pub enum ColorSpace {
20 ACESAP1, AppleWideGamut, ARRIWideGamut3, ARRIWideGamut4, CanonCinemaGamut,
21 DaVinciWideGamut, DciP3, DisplayP3, FGamut, FGamutC, PanasonicVGamut, Rec2020,
22 Rec709, SGamut3, SGamut3Cine, Srgb,
23}
24
25impl ColorSpace {
26 pub fn name(&self) -> &'static str {
27 match self {
28 ColorSpace::ACESAP1 => "ACES AP1",
29 ColorSpace::AppleWideGamut => "Apple Wide Gamut",
30 ColorSpace::ARRIWideGamut3 => "ARRI Wide Gamut 3", ColorSpace::ARRIWideGamut4 => "ARRI Wide Gamut 4",
31 ColorSpace::CanonCinemaGamut => "Canon Cinema Gamut",
32 ColorSpace::DaVinciWideGamut => "DaVinci Wide Gamut",
33 ColorSpace::DciP3 => "DCI-P3", ColorSpace::DisplayP3 => "Display P3",
34 ColorSpace::FGamut => "F-Gamut", ColorSpace::FGamutC => "F-Gamut C",
35 ColorSpace::PanasonicVGamut => "Panasonic V-Gamut",
36 ColorSpace::Rec2020 => "Rec.2020", ColorSpace::Rec709 => "Rec.709",
37 ColorSpace::SGamut3 => "S-Gamut3", ColorSpace::SGamut3Cine => "S-Gamut3.Cinema",
38 ColorSpace::Srgb => "sRGB",
39 }
40 }
41
42 pub fn get_white_point_chromaticities(&self) -> (f32, f32) {
43 match self {
44 ColorSpace::DciP3 => (0.314, 0.351),
45 ColorSpace::ACESAP1 => (0.32168, 0.33767),
46 _ => (0.3127, 0.3290),
47 }
48 }
49
50 pub fn get_xyz_to_rgb_matrix(&self) -> [f32; 9] {
51 match self {
52 ColorSpace::AppleWideGamut => xyz_to_rgb_from_primaries(0.725, 0.301, 0.221, 0.814, 0.068, -0.076, 0.3127, 0.3290),
53 ColorSpace::Rec709 | ColorSpace::Srgb => xyz_to_rec709(),
54 ColorSpace::Rec2020 | ColorSpace::FGamut => xyz_to_rgb_from_primaries(0.708, 0.292, 0.170, 0.797, 0.131, 0.046, 0.3127, 0.3290),
55 ColorSpace::DciP3 => xyz_to_rgb_from_primaries(0.680, 0.320, 0.265, 0.690, 0.150, 0.060, 0.314, 0.351),
56 ColorSpace::DisplayP3 => xyz_to_rgb_from_primaries(0.680, 0.320, 0.265, 0.690, 0.150, 0.060, 0.3127, 0.3290),
57 ColorSpace::SGamut3Cine => xyz_to_rgb_from_primaries(0.76600, 0.27500, 0.22500, 0.80000, 0.08900, -0.08700, 0.3127, 0.3290),
58 ColorSpace::SGamut3 => xyz_to_rgb_from_primaries(0.7300, 0.2800, 0.1400, 0.8550, 0.1000, -0.0500, 0.3127, 0.3290),
59 ColorSpace::ARRIWideGamut3 => xyz_to_rgb_from_primaries(0.6840, 0.3130, 0.2210, 0.8480, 0.0861, -0.1020, 0.3127, 0.3290),
60 ColorSpace::ARRIWideGamut4 => xyz_to_rgb_from_primaries(0.7347, 0.2653, 0.1424, 0.8576, 0.0991, -0.0308, 0.3127, 0.3290),
61 ColorSpace::CanonCinemaGamut => xyz_to_rgb_from_primaries(0.7400, 0.2700, 0.1700, 1.1400, 0.0800, -0.1000, 0.3127, 0.3290),
62 ColorSpace::PanasonicVGamut => xyz_to_rgb_from_primaries(0.7300, 0.2800, 0.1650, 0.8400, 0.1000, -0.0300, 0.3127, 0.3290),
63 ColorSpace::FGamutC => xyz_to_rgb_from_primaries(0.7347, 0.2653, 0.0263, 0.9737, 0.1173, -0.0224, 0.3127, 0.3290),
64 ColorSpace::DaVinciWideGamut => xyz_to_rgb_from_primaries(0.8000, 0.3130, 0.1682, 0.9877, 0.0790, -0.1155, 0.3127, 0.3290),
65 ColorSpace::ACESAP1 => xyz_to_rgb_from_primaries(0.71300, 0.29300, 0.16500, 0.83000, 0.12800, 0.04400, 0.32168, 0.33767),
66 }
67 }
68
69 pub fn all() -> &'static [ColorSpace] {
70 &[ColorSpace::ACESAP1, ColorSpace::AppleWideGamut, ColorSpace::ARRIWideGamut3, ColorSpace::ARRIWideGamut4,
72 ColorSpace::CanonCinemaGamut, ColorSpace::DaVinciWideGamut, ColorSpace::DciP3,
73 ColorSpace::DisplayP3, ColorSpace::FGamut, ColorSpace::FGamutC,
74 ColorSpace::PanasonicVGamut, ColorSpace::Rec2020, ColorSpace::Rec709,
75 ColorSpace::SGamut3, ColorSpace::SGamut3Cine, ColorSpace::Srgb]
76 }
77 pub fn next(self) -> Self { let all = Self::all(); let pos = all.iter().position(|&x| x == self).unwrap_or(0); all[(pos + 1) % all.len()] }
78 pub fn prev(self) -> Self { let all = Self::all(); let pos = all.iter().position(|&x| x == self).unwrap_or(0); all[(pos + all.len() - 1) % all.len()] }
79}
80
81#[derive(Debug, Clone, Copy, PartialEq, Eq)]
82pub enum TransferFunction {
83 ACESCCT, ARRIlog3, ARRIlog4, AppleLog, AppleLog2, CLog3, DaVinciIntermediate,
84 FLog2, Gamma24, HLG, Linear, PQ, Rec709, SLog3, VLog,
85}
86
87impl TransferFunction {
88 pub fn name(&self) -> &'static str {
89 match self {
90 TransferFunction::ACESCCT => "ACES CCT",
91 TransferFunction::ARRIlog3 => "ARRI LogC3", TransferFunction::ARRIlog4 => "ARRI LogC4",
92 TransferFunction::AppleLog => "Apple Log", TransferFunction::AppleLog2 => "Apple Log 2",
93 TransferFunction::CLog3 => "C-Log3",
94 TransferFunction::DaVinciIntermediate => "DaVinci Intermediate",
95 TransferFunction::FLog2 => "F-Log2", TransferFunction::Gamma24 => "Gamma 2.4",
96 TransferFunction::HLG => "HLG (BT.2100)", TransferFunction::Linear => "Linear",
97 TransferFunction::PQ => "PQ (ST.2084)", TransferFunction::Rec709 => "Rec.709",
98 TransferFunction::SLog3 => "S-Log3", TransferFunction::VLog => "V-Log",
99 }
100 }
101
102 pub fn process(&self, pixels: &mut [f32]) {
123 match self {
124 TransferFunction::Linear => {}
125 TransferFunction::Rec709 => { pixels.par_iter_mut().for_each(|v| { *v = rec709_oetf(*v).min(1.0).max(0.0); }); }
127 TransferFunction::SLog3 => { pixels.par_iter_mut().for_each(|v| { let x = *v; *v = if x >= 0.01125_f32 { (420.0_f32 + 261.5_f32 * ((x + 0.01_f32) / 0.19_f32).log10()) / 1023.0_f32 } else { (x * (171.2102946929_f32 - 95.0_f32) / 0.01125_f32 + 95.0_f32) / 1023.0_f32 }; }); }
133 TransferFunction::VLog => { pixels.par_iter_mut().for_each(|v| { let x = *v; *v = if x < 0.01 { 5.6_f32 * x + 0.125_f32 } else { 0.241514_f32 * (x + 0.00873_f32).log10() + 0.598206_f32 }; }); }
135 TransferFunction::ARRIlog3 => { pixels.par_iter_mut().for_each(|v| { let x = *v; *v = if x > 0.010591_f32 { 0.247190_f32 * (5.555556_f32 * x + 0.052272_f32).log10() + 0.385537_f32 } else { 5.367655_f32 * x + 0.092809_f32 }; }); }
137 TransferFunction::ARRIlog4 => {
144 let (a, b, c, s, t) = arri_logc4_constants();
145 pixels.par_iter_mut().for_each(|v| {
146 let x = *v;
147 *v = if x >= t {
148 ((a * x + 64.0_f32).log2() - 6.0_f32) / 14.0_f32 * b + c
149 } else {
150 (x - t) / s
151 };
152 });
153 }
154 TransferFunction::CLog3 => {
157 let neg_graft_lin = (0.097465473_f32 - 0.12512219_f32) / 1.9754798_f32;
158 let pos_graft_lin = (0.15277891_f32 - 0.12512219_f32) / 1.9754798_f32;
159 pixels.par_iter_mut().for_each(|v| {
160 let x = *v;
161 *v = if x < neg_graft_lin { -0.36726845_f32 * ((-x * 14.98325_f32 + 1.0_f32).max(1e-10_f32)).log10() + 0.12783901_f32 }
162 else if x <= pos_graft_lin { 1.9754798_f32 * x + 0.12512219_f32 }
163 else { 0.36726845_f32 * (x * 14.98325_f32 + 1.0_f32).log10() + 0.12240537_f32 };
164 });
165 }
166 TransferFunction::FLog2 => { pixels.par_iter_mut().for_each(|v| { let x = *v; *v = if x >= 0.000889_f32 { 0.245281_f32 * (5.555556_f32 * x + 0.064829_f32).log10() + 0.384316_f32 } else { 8.799461_f32 * x + 0.092864_f32 }; }); }
168 TransferFunction::AppleLog | TransferFunction::AppleLog2 => {
170 pixels.par_iter_mut().for_each(|v| {
171 let x = *v;
172 const R0: f32 = -0.05641088; const RT: f32 = 0.01; const C: f32 = 47.28711236;
173 const BETA: f32 = 0.00964052; const GAMMA: f32 = 0.08550479; const DELTA: f32 = 0.69336945;
174 *v = if x < R0 { 0.0 } else if x < RT { C * (x - R0) * (x - R0) } else { GAMMA * (x + BETA).log2() + DELTA };
175 });
176 }
177 TransferFunction::ACESCCT => { pixels.par_iter_mut().for_each(|v| { let x = *v; *v = if x > 0.0078125_f32 { (x.log2() + 9.72_f32) / 17.52_f32 } else { 10.5402377416545_f32 * x + 0.0729055341958355_f32 }; }); }
179 TransferFunction::PQ => { pixels.par_iter_mut().for_each(|v| { let x = (*v).max(0.0_f32); let x_m1 = x.powf(0.1593017578125_f32); *v = ((0.8359375_f32 + 18.8515625_f32 * x_m1) / (1.0_f32 + 18.6875_f32 * x_m1)).powf(78.84375_f32); }); }
182 TransferFunction::HLG => { pixels.par_iter_mut().for_each(|v| { let x = (*v).max(0.0_f32); *v = if x < (1.0_f32 / 12.0_f32) { (3.0_f32 * x).sqrt() } else { 0.17883277_f32 * (12.0_f32 * x - 0.28466892_f32).ln() + 0.55991073_f32 }; }); }
187 TransferFunction::DaVinciIntermediate => { pixels.par_iter_mut().for_each(|v| { let x = *v; *v = if x <= 0.00262409_f32 { x * 10.44426855_f32 } else { 0.07329248_f32 * ((x + 0.0075_f32).log2() + 7.0_f32) }; }); }
189 TransferFunction::Gamma24 => { pixels.par_iter_mut().for_each(|v| { *v = v.max(0.0).powf(1.0 / 2.4); }); }
192 }
193 }
194
195 pub fn all() -> &'static [TransferFunction] {
196 &[TransferFunction::ACESCCT, TransferFunction::ARRIlog3, TransferFunction::ARRIlog4,
198 TransferFunction::AppleLog, TransferFunction::AppleLog2, TransferFunction::CLog3,
199 TransferFunction::DaVinciIntermediate, TransferFunction::FLog2,
200 TransferFunction::Gamma24, TransferFunction::HLG, TransferFunction::Linear,
201 TransferFunction::PQ, TransferFunction::Rec709, TransferFunction::SLog3,
202 TransferFunction::VLog]
203 }
204 pub fn next(self) -> Self { let all = Self::all(); let pos = all.iter().position(|&x| x == self).unwrap_or(0); all[(pos + 1) % all.len()] }
205 pub fn prev(self) -> Self { let all = Self::all(); let pos = all.iter().position(|&x| x == self).unwrap_or(0); all[(pos + all.len() - 1) % all.len()] }
206 pub fn is_log_bypass(&self) -> bool { !matches!(self, TransferFunction::Linear | TransferFunction::Rec709 | TransferFunction::Gamma24) }
207 pub fn requires_10bit(&self) -> bool { !matches!(self, TransferFunction::Linear | TransferFunction::Rec709 | TransferFunction::Gamma24) }
208}
209
210#[inline] pub fn rec709_oetf(x: f32) -> f32 { if x < 0.018 { 4.5 * x } else { 1.099 * x.powf(0.45) - 0.099 } }
211#[inline] pub fn rec709_eotf(x: f32) -> f32 { if x < 0.0812429 { x / 4.5 } else { ((x + 0.099) / 1.099).powf(1.0 / 0.45) } }
212
213pub fn arri_logc4_constants() -> (f32, f32, f32, f32, f32) {
225 let a: f32 = ((1u32 << 18) as f32 - 16.0) / 117.45;
226 let b: f32 = (1023.0 - 95.0) / 1023.0;
227 let c: f32 = 95.0 / 1023.0;
228 let s: f32 = (7.0 * std::f32::consts::LN_2 * (7.0 - 14.0 * c / b).exp2()) / (a * b);
229 let t: f32 = ((14.0 * (-c / b) + 6.0).exp2() - 64.0) / a;
230 (a, b, c, s, t)
231}
232
233#[inline]
236pub fn arri_logc4_oetf(x: f32) -> f32 {
237 let (a, b, c, s, t) = arri_logc4_constants();
238 if x >= t {
239 ((a * x + 64.0).log2() - 6.0) / 14.0 * b + c
240 } else {
241 (x - t) / s
242 }
243}
244
245#[inline]
248pub fn arri_logc4_eotf(y: f32) -> f32 {
249 let (a, b, c, s, t) = arri_logc4_constants();
250 if y >= 0.0 {
251 ((14.0 * ((y - c) / b) + 6.0).exp2() - 64.0) / a
252 } else {
253 y * s + t
254 }
255}
256#[inline] pub fn apply_ccm(r: f32, g: f32, b: f32, ccm: &[f32; 9]) -> [f32; 3] { [r * ccm[0] + g * ccm[1] + b * ccm[2], r * ccm[3] + g * ccm[4] + b * ccm[5], r * ccm[6] + g * ccm[7] + b * ccm[8]] }
257pub fn identity_ccm() -> [f32; 9] { [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0] }
258
259pub fn invert_3x3(m: &[f32; 9]) -> [f32; 9] {
260 let det = m[0] * (m[4] * m[8] - m[5] * m[7]) - m[1] * (m[3] * m[8] - m[5] * m[6]) + m[2] * (m[3] * m[7] - m[4] * m[6]);
261 let inv_det = 1.0 / det;
262 [
263 (m[4] * m[8] - m[5] * m[7]) * inv_det, (m[2] * m[7] - m[1] * m[8]) * inv_det, (m[1] * m[5] - m[2] * m[4]) * inv_det,
264 (m[5] * m[6] - m[3] * m[8]) * inv_det, (m[0] * m[8] - m[2] * m[6]) * inv_det, (m[2] * m[3] - m[0] * m[5]) * inv_det,
265 (m[3] * m[7] - m[4] * m[6]) * inv_det, (m[1] * m[6] - m[0] * m[7]) * inv_det, (m[0] * m[4] - m[1] * m[3]) * inv_det,
266 ]
267}
268
269pub fn mat_mul_3x3(a: &[f32; 9], b: &[f32; 9]) -> [f32; 9] {
270 let mut out = [0.0; 9];
271 for i in 0..3 { for j in 0..3 { out[i * 3 + j] = a[i * 3] * b[j] + a[i * 3 + 1] * b[3 + j] + a[i * 3 + 2] * b[6 + j]; } }
272 out
273}
274
275pub fn camera_to_rec709_matrix(color_matrix: &[f32; 9]) -> [f32; 9] {
276 let cam_to_xyz = detect_camera_to_xyz(color_matrix);
277 let d50_to_d65 = [0.9555, -0.0230, 0.0633, -0.0283, 1.0099, 0.0210, 0.0123, -0.0205, 1.3300];
278 let cam_to_xyz_d65 = mat_mul_3x3(&d50_to_d65, &cam_to_xyz);
279 mat_mul_3x3(&xyz_to_rec709(), &cam_to_xyz_d65)
280}
281
282pub fn rec709_to_xyz() -> [f32; 9] { [0.4124564, 0.3575761, 0.1804375, 0.2126729, 0.7151522, 0.0721750, 0.0193339, 0.1191920, 0.9503041] }
283
284pub(crate) const MCAT16: [f32; 9] = [0.401288, 0.650173, -0.051461, -0.250268, 1.204414, 0.045854, -0.002079, 0.048952, 0.953127];
285pub(crate) const MCAT16_INV: [f32; 9] = [1.86206786, -1.01125463, 0.14918678, 0.38752654, 0.62144744, -0.00897398, -0.01584150, -0.03412294, 1.04996444];
286pub const D50_XYZ: [f32; 3] = [0.96422, 1.0, 0.82521];
287pub const D65_XYZ: [f32; 3] = [0.95047, 1.0, 1.08883];
288
289pub fn xyz_from_chromaticities(x: f32, y: f32) -> [f32; 3] { let z = 1.0 - x - y; [x / y, 1.0, z / y] }
290
291pub fn cat16_adapt(xyz: &[f32; 3], src_white: &[f32; 3], dst_white: &[f32; 3]) -> [f32; 3] {
292 let [l_s, m_s, s_s] = mat_mul_vec3(&MCAT16, src_white);
293 let [l_d, m_d, s_d] = mat_mul_vec3(&MCAT16, dst_white);
294 let lms = mat_mul_vec3(&MCAT16, xyz);
295 let adapted = [lms[0] * (l_d / l_s), lms[1] * (m_d / m_s), lms[2] * (s_d / s_s)];
296 mat_mul_vec3(&MCAT16_INV, &adapted)
297}
298
299pub fn build_cat16_output_matrix(cam_to_xyz: &[f32; 9], scene_white_xyz: &[f32; 3], dst_white: &[f32; 3], xyz_to_output: &[f32; 9]) -> [f32; 9] {
300 let [l_s, m_s, s_s] = mat_mul_vec3(&MCAT16, scene_white_xyz);
301 let [l_d, m_d, s_d] = mat_mul_vec3(&MCAT16, dst_white);
302 let r_l = l_d / l_s; let r_m = m_d / m_s; let r_s = s_d / s_s;
303 let rgb_to_lms = mat_mul_3x3(&MCAT16, cam_to_xyz);
304 let rgb_to_adapted = [
305 rgb_to_lms[0] * r_l, rgb_to_lms[1] * r_l, rgb_to_lms[2] * r_l,
306 rgb_to_lms[3] * r_m, rgb_to_lms[4] * r_m, rgb_to_lms[5] * r_m,
307 rgb_to_lms[6] * r_s, rgb_to_lms[7] * r_s, rgb_to_lms[8] * r_s,
308 ];
309 let rgb_to_xyz = mat_mul_3x3(&MCAT16_INV, &rgb_to_adapted);
310 mat_mul_3x3(xyz_to_output, &rgb_to_xyz)
311}
312
313#[inline]
314pub fn mat_mul_vec3(m: &[f32; 9], v: &[f32; 3]) -> [f32; 3] {
315 [m[0] * v[0] + m[1] * v[1] + m[2] * v[2], m[3] * v[0] + m[4] * v[1] + m[5] * v[2], m[6] * v[0] + m[7] * v[1] + m[8] * v[2]]
316}
317
318pub(crate) const BRADFORD: [f32; 9] = [
320 0.8951000, 0.2664000, -0.1614000,
321 -0.7502000, 1.7135000, 0.0367000,
322 0.0389000, -0.0685000, 1.0296000,
323];
324
325pub(crate) const BRADFORD_INV: [f32; 9] = [
327 0.9869929, -0.1470543, 0.1599627,
328 0.4323053, 0.5183603, 0.0492912,
329 -0.0085287, 0.0400428, 0.9684867,
330];
331
332pub fn build_bradford_matrix(src_white: &[f32; 3], dst_white: &[f32; 3]) -> [f32; 9] {
334 let [rho_s, gamma_s, beta_s] = mat_mul_vec3(&BRADFORD, src_white);
335 let [rho_d, gamma_d, beta_d] = mat_mul_vec3(&BRADFORD, dst_white);
336
337 let scale = [
338 rho_d / rho_s, 0.0, 0.0,
339 0.0, gamma_d / gamma_s, 0.0,
340 0.0, 0.0, beta_d / beta_s,
341 ];
342
343 let temp = mat_mul_3x3(&scale, &BRADFORD);
344 mat_mul_3x3(&BRADFORD_INV, &temp)
345}
346
347pub fn detect_camera_to_xyz(m: &[f32; 9]) -> [f32; 9] {
362 let d50 = D50_XYZ;
363 let transposed = [
364 m[0], m[3], m[6],
365 m[1], m[4], m[7],
366 m[2], m[5], m[8],
367 ];
368 let inv = invert_3x3(m);
369 let inv_t = invert_3x3(&transposed);
370
371 let candidates: [[f32; 9]; 4] = [*m, transposed, inv, inv_t];
372
373 let mut best = *m;
379 let mut best_dist = f32::MAX;
380 for c in &candidates {
381 let w = [c[0] + c[1] + c[2], c[3] + c[4] + c[5], c[6] + c[7] + c[8]];
382 let dx = w[0] - d50[0];
383 let dy = w[1] - d50[1];
384 let dz = w[2] - d50[2];
385 let dist = dx * dx + dy * dy + dz * dz;
386 if dist < best_dist {
387 best_dist = dist;
388 best = *c;
389 }
390 }
391 tracing::debug!(
392 "detect_camera_to_xyz: white=[{:.3},{:.3},{:.3}] dist={:.4}",
393 best[0] + best[1] + best[2],
394 best[3] + best[4] + best[5],
395 best[6] + best[7] + best[8],
396 best_dist.sqrt()
397 );
398 best
399}
400
401pub fn camera_to_xyz_matrix(color_matrix: &[f32; 9], calibration_matrix: Option<&[f32; 9]>) -> [f32; 9] {
405 let cam_to_xyz = detect_camera_to_xyz(color_matrix);
406 match calibration_matrix {
407 Some(cal) => mat_mul_3x3(&cam_to_xyz, cal),
411 None => cam_to_xyz,
412 }
413}
414
415pub fn forward_to_camera_xyz(forward_matrix: &[f32; 9]) -> [f32; 9] {
418 detect_camera_to_xyz(forward_matrix)
419}
420
421pub fn build_preview_ccm(
434 color_matrix: Option<&[f64; 9]>,
435 forward_matrix1: Option<&[f64; 9]>,
436 forward_matrix2: Option<&[f64; 9]>,
437 color_matrix2: Option<&[f64; 9]>,
438 calibration_matrix1: Option<&[f64; 9]>,
439) -> [f32; 9] {
440 let cm1_f32 = color_matrix.map(|m| [m[0] as f32, m[1] as f32, m[2] as f32, m[3] as f32, m[4] as f32, m[5] as f32, m[6] as f32, m[7] as f32, m[8] as f32]);
441 let cm2_f32 = color_matrix2.map(|m| [m[0] as f32, m[1] as f32, m[2] as f32, m[3] as f32, m[4] as f32, m[5] as f32, m[6] as f32, m[7] as f32, m[8] as f32]);
442 let fm1_f32 = forward_matrix1.map(|m| [m[0] as f32, m[1] as f32, m[2] as f32, m[3] as f32, m[4] as f32, m[5] as f32, m[6] as f32, m[7] as f32, m[8] as f32]);
443 let fm2_f32 = forward_matrix2.map(|m| [m[0] as f32, m[1] as f32, m[2] as f32, m[3] as f32, m[4] as f32, m[5] as f32, m[6] as f32, m[7] as f32, m[8] as f32]);
444 let cal1_f32 = calibration_matrix1.map(|m| [m[0] as f32, m[1] as f32, m[2] as f32, m[3] as f32, m[4] as f32, m[5] as f32, m[6] as f32, m[7] as f32, m[8] as f32]);
445
446 let cam_to_xyz: [f32; 9] = if let (Some(ref fm1), Some(ref fm2)) = (fm1_f32, fm2_f32) {
447 let fm_avg = interpolate_matrix(fm1, fm2, 0.5);
448 let rs = [fm_avg[0] + fm_avg[1] + fm_avg[2], fm_avg[3] + fm_avg[4] + fm_avg[5], fm_avg[6] + fm_avg[7] + fm_avg[8]];
449 let d = (rs[0] - D50_XYZ[0]).powi(2) + (rs[1] - D50_XYZ[1]).powi(2) + (rs[2] - D50_XYZ[2]).powi(2);
450 if d < 0.05 { fm_avg } else { detect_camera_to_xyz(&fm_avg) }
451 } else if let Some(ref fm1) = fm1_f32 {
452 let rs = [fm1[0] + fm1[1] + fm1[2], fm1[3] + fm1[4] + fm1[5], fm1[6] + fm1[7] + fm1[8]];
453 let d = (rs[0] - D50_XYZ[0]).powi(2) + (rs[1] - D50_XYZ[1]).powi(2) + (rs[2] - D50_XYZ[2]).powi(2);
454 if d < 0.05 { *fm1 } else { detect_camera_to_xyz(fm1) }
455 } else if let Some(ref cm1) = cm1_f32 {
456 let cal = cal1_f32;
457 match cm2_f32 {
458 Some(ref cm2) => {
459 let cm_avg = interpolate_matrix(cm1, cm2, 0.5);
460 camera_to_xyz_matrix(&cm_avg, cal.as_ref())
461 }
462 None => camera_to_xyz_matrix(cm1, cal.as_ref()),
463 }
464 } else {
465 identity_ccm()
466 };
467
468 let rs = [cam_to_xyz[0] + cam_to_xyz[1] + cam_to_xyz[2], cam_to_xyz[3] + cam_to_xyz[4] + cam_to_xyz[5], cam_to_xyz[6] + cam_to_xyz[7] + cam_to_xyz[8]];
470 let cam_illuminant_xyz = if fm1_f32.is_some() {
471 D50_XYZ
472 } else {
473 let l = rs[0].max(rs[1]).max(rs[2]);
474 if l < 0.1 || l > 5.0 { D50_XYZ } else { rs }
475 };
476
477 let bradford_static = build_bradford_matrix(&cam_illuminant_xyz, &D65_XYZ);
478 let cam_to_xyz_d65 = mat_mul_3x3(&bradford_static, &cam_to_xyz);
479 mat_mul_3x3(&xyz_to_rec709(), &cam_to_xyz_d65)
480}
481
482pub fn interpolate_matrix(a: &[f32; 9], b: &[f32; 9], t: f32) -> [f32; 9] {
483 let s = 1.0 - t; let mut out = [0.0; 9];
484 for i in 0..9 { out[i] = a[i] * s + b[i] * t; }
485 out
486}
487
488pub fn xyz_to_rec709() -> [f32; 9] { [3.2404542, -1.5371385, -0.4985354, -0.9689294, 1.8767608, 0.0415560, 0.0556434, -0.2040259, 1.0572252] }
489
490pub fn xyz_to_rgb_from_primaries(xr: f32, yr: f32, xg: f32, yg: f32, xb: f32, yb: f32, xw: f32, yw: f32) -> [f32; 9] {
491 let xr_z = (1.0 - xr - yr) / yr; let xg_z = (1.0 - xg - yg) / yg; let xb_z = (1.0 - xb - yb) / yb;
492 let m = [xr / yr, xg / yg, xb / yb, 1.0, 1.0, 1.0, xr_z, xg_z, xb_z];
493 let wx = xw / yw; let wy = 1.0; let wz = (1.0 - xw - yw) / yw;
494 let det_m = m[0] * (m[4] * m[8] - m[5] * m[7]) - m[1] * (m[3] * m[8] - m[5] * m[6]) + m[2] * (m[3] * m[7] - m[4] * m[6]);
495 let inv_det = 1.0 / det_m;
496 let inv_m = [
497 (m[4] * m[8] - m[5] * m[7]) * inv_det, (m[2] * m[7] - m[1] * m[8]) * inv_det, (m[1] * m[5] - m[2] * m[4]) * inv_det,
498 (m[5] * m[6] - m[3] * m[8]) * inv_det, (m[0] * m[8] - m[2] * m[6]) * inv_det, (m[2] * m[3] - m[0] * m[5]) * inv_det,
499 (m[3] * m[7] - m[4] * m[6]) * inv_det, (m[1] * m[6] - m[0] * m[7]) * inv_det, (m[0] * m[4] - m[1] * m[3]) * inv_det,
500 ];
501 let sr = inv_m[0] * wx + inv_m[1] * wy + inv_m[2] * wz;
502 let sg = inv_m[3] * wx + inv_m[4] * wy + inv_m[5] * wz;
503 let sb = inv_m[6] * wx + inv_m[7] * wy + inv_m[8] * wz;
504 let rgb_to_xyz = [m[0] * sr, m[1] * sg, m[2] * sb, m[3] * sr, m[4] * sg, m[5] * sb, m[6] * sr, m[7] * sg, m[8] * sb];
505 invert_3x3(&rgb_to_xyz)
506}
507
508pub struct BilinearDemosaic { pattern: BayerPattern }
509impl BilinearDemosaic {
510 pub fn new(pattern: BayerPattern) -> Self { BilinearDemosaic { pattern } }
511
512 fn get_pixel(&self, bayer: &[u16], stride_width: u32, x: i32, y: i32) -> f64 {
513 if x < 0 || y < 0 || x >= stride_width as i32 { return 0.0; }
514 let idx = (y as usize) * (stride_width as usize) + (x as usize);
515 if idx >= bayer.len() { return 0.0; }
516 bayer[idx] as f64
517 }
518
519 fn is_red_site(&self, x: i32, y: i32, pattern: BayerPattern) -> bool {
520 match pattern {
521 BayerPattern::RGGB => x % 2 == 0 && y % 2 == 0,
522 BayerPattern::BGGR => x % 2 == 1 && y % 2 == 1,
523 BayerPattern::GRBG => x % 2 == 1 && y % 2 == 0,
524 BayerPattern::GBRG => x % 2 == 0 && y % 2 == 1,
525 _ => false,
526 }
527 }
528
529 fn is_blue_site(&self, x: i32, y: i32, pattern: BayerPattern) -> bool {
530 match pattern {
531 BayerPattern::RGGB => x % 2 == 1 && y % 2 == 1,
532 BayerPattern::BGGR => x % 2 == 0 && y % 2 == 0,
533 BayerPattern::GRBG => x % 2 == 0 && y % 2 == 1,
534 BayerPattern::GBRG => x % 2 == 1 && y % 2 == 0,
535 _ => false,
536 }
537 }
538
539 fn interp_green_at_red(&self, bayer: &[u16], stride: u32, _height: u32, x: i32, y: i32, pattern: BayerPattern) -> f64 {
540 let mut sum = 0.0; let mut count = 0.0;
541 let positions = [(0, -1), (0, 1), (-1, 0), (1, 0)];
542 for (dx, dy) in positions.iter() {
543 let px = x + dx; let py = y + dy;
544 if self.is_green_site(px, py, pattern) { sum += self.get_pixel(bayer, stride, px, py); count += 1.0; }
545 }
546 if count > 0.0 { sum / count } else { self.get_pixel(bayer, stride, x, y) }
547 }
548
549 fn interp_green_at_blue(&self, bayer: &[u16], stride: u32, height: u32, x: i32, y: i32, pattern: BayerPattern) -> f64 {
550 self.interp_green_at_red(bayer, stride, height, x, y, pattern)
551 }
552
553 fn interp_blue_at_red(&self, bayer: &[u16], stride: u32, _height: u32, x: i32, y: i32, pattern: BayerPattern) -> f64 {
554 let mut sum = 0.0; let mut count = 0.0;
555 let positions = [(-1, -1), (1, -1), (-1, 1), (1, 1)];
556 for (dx, dy) in positions.iter() {
557 let px = x + dx; let py = y + dy;
558 if self.is_blue_site(px, py, pattern) { sum += self.get_pixel(bayer, stride, px, py); count += 1.0; }
559 }
560 if count > 0.0 { sum / count } else { self.get_pixel(bayer, stride, x, y) }
561 }
562
563 fn interp_red_at_blue(&self, bayer: &[u16], stride: u32, _height: u32, x: i32, y: i32, pattern: BayerPattern) -> f64 {
564 let mut sum = 0.0; let mut count = 0.0;
565 let positions = [(-1, -1), (1, -1), (-1, 1), (1, 1)];
566 for (dx, dy) in positions.iter() {
567 let px = x + dx; let py = y + dy;
568 if self.is_red_site(px, py, pattern) { sum += self.get_pixel(bayer, stride, px, py); count += 1.0; }
569 }
570 if count > 0.0 { sum / count } else { self.get_pixel(bayer, stride, x, y) }
571 }
572
573 fn is_green_site(&self, x: i32, y: i32, pattern: BayerPattern) -> bool {
574 !self.is_red_site(x, y, pattern) && !self.is_blue_site(x, y, pattern)
575 }
576
577 pub fn process_par(&self, bayer: &[u16], stride_width: u32, offset_x: u32, offset_y: u32, active_width: u32, active_height: u32, pattern: &BayerPattern) -> Result<Vec<f32>> {
578 let stride = stride_width as usize; let ox = offset_x as i32; let oy = offset_y as i32;
579 let aw = active_width as usize; let ah = active_height as usize;
580 let min_len = (stride * (oy as usize + ah - 1) + ox as usize + aw - 1) + 1;
581 if bayer.len() < min_len { anyhow::bail!("Bayer data too short"); }
582 let mut rgb = vec![0.0f32; aw * ah * 3]; let pat = *pattern; let row_len = aw * 3;
583 rgb.par_chunks_exact_mut(row_len).enumerate().for_each(|(sy, row)| {
584 let y = sy as i32 + oy;
585 for sx in 0..aw {
586 let x = sx as i32 + ox;
587 let is_red = self.is_red_site(x, y, pat); let is_blue = self.is_blue_site(x, y, pat);
588 let (r, g, b) = if is_red {
589 (self.get_pixel(bayer, stride_width, x, y), self.interp_green_at_red(bayer, stride_width, active_height, x, y, pat), self.interp_blue_at_red(bayer, stride_width, active_height, x, y, pat))
590 } else if is_blue {
591 (self.interp_red_at_blue(bayer, stride_width, active_height, x, y, pat), self.interp_green_at_blue(bayer, stride_width, active_height, x, y, pat), self.get_pixel(bayer, stride_width, x, y))
592 } else {
593 let is_top_green = match pat {
595 BayerPattern::RGGB | BayerPattern::BGGR => y % 2 == 0,
596 BayerPattern::GRBG => y % 2 == 0,
597 BayerPattern::GBRG => y % 2 == 0,
598 _ => y % 2 == 0,
599 };
600 if is_top_green {
601 (self.interp_red_at_blue(bayer, stride_width, active_height, x + 1, y, pat), self.get_pixel(bayer, stride_width, x, y), self.interp_blue_at_red(bayer, stride_width, active_height, x - 1, y, pat))
602 } else {
603 (self.interp_red_at_blue(bayer, stride_width, active_height, x - 1, y, pat), self.get_pixel(bayer, stride_width, x, y), self.interp_blue_at_red(bayer, stride_width, active_height, x + 1, y, pat))
604 }
605 };
606 let base = sx * 3; row[base] = r as f32; row[base + 1] = g as f32; row[base + 2] = b as f32;
607 }
608 });
609 Ok(rgb)
610 }
611
612 pub fn process_par_into(&self, bayer: &[u16], stride_width: u32, offset_x: u32, offset_y: u32, active_width: u32, active_height: u32, pattern: &BayerPattern, output: &mut [f32]) -> Result<()> {
613 let stride = stride_width as usize; let ox = offset_x as i32; let oy = offset_y as i32;
614 let aw = active_width as usize; let ah = active_height as usize;
615 let min_len = (stride * (oy as usize + ah - 1) + ox as usize + aw - 1) + 1;
616 if bayer.len() < min_len { anyhow::bail!("Bayer data too short"); }
617 if output.len() < aw * ah * 3 { anyhow::bail!("Output buffer too short"); }
618 let pat = *pattern; let row_len = aw * 3;
619 output.par_chunks_exact_mut(row_len).enumerate().for_each(|(sy, row)| {
620 let y = sy as i32 + oy;
621 for sx in 0..aw {
622 let x = sx as i32 + ox;
623 let is_red = self.is_red_site(x, y, pat); let is_blue = self.is_blue_site(x, y, pat);
624 let (r, g, b) = if is_red {
625 (self.get_pixel(bayer, stride_width, x, y), self.interp_green_at_red(bayer, stride_width, active_height, x, y, pat), self.interp_blue_at_red(bayer, stride_width, active_height, x, y, pat))
626 } else if is_blue {
627 (self.interp_red_at_blue(bayer, stride_width, active_height, x, y, pat), self.interp_green_at_blue(bayer, stride_width, active_height, x, y, pat), self.get_pixel(bayer, stride_width, x, y))
628 } else {
629 let is_top_green = match pat {
631 BayerPattern::RGGB | BayerPattern::BGGR => y % 2 == 0,
632 BayerPattern::GRBG => y % 2 == 0,
633 BayerPattern::GBRG => y % 2 == 0,
634 _ => y % 2 == 0,
635 };
636 if is_top_green {
637 (self.interp_red_at_blue(bayer, stride_width, active_height, x + 1, y, pat), self.get_pixel(bayer, stride_width, x, y), self.interp_blue_at_red(bayer, stride_width, active_height, x - 1, y, pat))
638 } else {
639 (self.interp_red_at_blue(bayer, stride_width, active_height, x - 1, y, pat), self.get_pixel(bayer, stride_width, x, y), self.interp_blue_at_red(bayer, stride_width, active_height, x + 1, y, pat))
640 }
641 };
642 let base = sx * 3; row[base] = r as f32; row[base + 1] = g as f32; row[base + 2] = b as f32;
643 }
644 });
645 Ok(())
646 }
647}
648
649impl Demosaic for BilinearDemosaic {
650 fn process(&self, bayer: &[u16], stride_width: u32, offset_x: u32, offset_y: u32, active_width: u32, active_height: u32, pattern: &BayerPattern) -> Result<Vec<f32>> {
651 let stride = stride_width as usize; let ox = offset_x as i32; let oy = offset_y as i32;
652 let aw = active_width as usize; let ah = active_height as usize;
653 let min_len = (stride * (oy as usize + ah - 1) + ox as usize + aw - 1) + 1;
654 if bayer.len() < min_len { anyhow::bail!("Bayer data too short"); }
655 let mut rgb = Vec::with_capacity(aw * ah * 3); let pat = *pattern;
656 for sy in 0..ah as i32 {
657 for sx in 0..aw as i32 {
658 let x = sx + ox; let y = sy + oy;
659 let is_red = self.is_red_site(x, y, pat); let is_blue = self.is_blue_site(x, y, pat);
660 let (r, g, b) = if is_red {
661 (self.get_pixel(bayer, stride_width, x, y), self.interp_green_at_red(bayer, stride_width, active_height, x, y, pat), self.interp_blue_at_red(bayer, stride_width, active_height, x, y, pat))
662 } else if is_blue {
663 (self.interp_red_at_blue(bayer, stride_width, active_height, x, y, pat), self.interp_green_at_blue(bayer, stride_width, active_height, x, y, pat), self.get_pixel(bayer, stride_width, x, y))
664 } else {
665 let is_top_green = match pat {
667 BayerPattern::RGGB | BayerPattern::BGGR => y % 2 == 0,
668 BayerPattern::GRBG => y % 2 == 0,
669 BayerPattern::GBRG => y % 2 == 0,
670 _ => y % 2 == 0,
671 };
672 if is_top_green {
673 (self.interp_red_at_blue(bayer, stride_width, active_height, x + 1, y, pat), self.get_pixel(bayer, stride_width, x, y), self.interp_blue_at_red(bayer, stride_width, active_height, x - 1, y, pat))
674 } else {
675 (self.interp_red_at_blue(bayer, stride_width, active_height, x - 1, y, pat), self.get_pixel(bayer, stride_width, x, y), self.interp_blue_at_red(bayer, stride_width, active_height, x + 1, y, pat))
676 }
677 };
678 rgb.push(r as f32); rgb.push(g as f32); rgb.push(b as f32);
679 }
680 }
681 Ok(rgb)
682 }
683}
684
685pub struct CcmColorSpaceConverter;
686impl CcmColorSpaceConverter { pub fn new() -> Self { CcmColorSpaceConverter } }
687impl Default for CcmColorSpaceConverter { fn default() -> Self { Self::new() } }
688impl ColorSpaceConverter for CcmColorSpaceConverter {
689 fn process(&self, pixels: &mut [f32], ccm: &[f32; 9]) {
690 for chunk in pixels.chunks_exact_mut(3) {
691 let [r_out, g_out, b_out] = apply_ccm(chunk[0], chunk[1], chunk[2], ccm);
692 chunk[0] = r_out.max(0.0).min(1.0); chunk[1] = g_out.max(0.0).min(1.0); chunk[2] = b_out.max(0.0).min(1.0);
693 }
694 }
695}
696
697pub struct Rec709TransferFunction;
698impl Rec709TransferFunction { pub fn new() -> Self { Rec709TransferFunction } }
699impl TransferFunctionProcessor for Rec709TransferFunction {
700 fn process(&self, pixels: &mut [f32]) { pixels.par_iter_mut().for_each(|v| { *v = rec709_oetf(*v).min(1.0).max(0.0); }); }
701}
702
703pub struct LinearTransferFunction;
704impl LinearTransferFunction { pub fn new() -> Self { LinearTransferFunction } }
705impl TransferFunctionProcessor for LinearTransferFunction { fn process(&self, _pixels: &mut [f32]) {} }
706
707pub struct AgxKrakenPipeline { demosaic: BilinearDemosaic, agx: AgxPipeline, output_gamma: f32, enable_tonemap: bool }
708impl AgxKrakenPipeline {
709 pub fn new(pattern: BayerPattern) -> Self {
710 let config = ColorPipelineConfig::broadcast(); let demosaic = BilinearDemosaic::new(pattern);
711 let agx = AgxPipeline::new(config.tonemap_config.clone()); let output_gamma = config.output_gamma.gamma();
712 let enable_tonemap = config.enable_tonemapping;
713 AgxKrakenPipeline { demosaic, agx, output_gamma, enable_tonemap }
714 }
715}
716
717#[derive(Debug, Clone, Copy, PartialEq, Eq)] pub enum OutputGamma { Srgb, Bt1886, Linear }
718impl OutputGamma { pub fn gamma(&self) -> f32 { match self { OutputGamma::Srgb => 2.2, OutputGamma::Bt1886 => 2.4, OutputGamma::Linear => 1.0 } } }
719
720pub struct ColorPipelineConfig {
721 pub input_color_space: ColorSpace, pub input_transfer: TransferFunction, pub output_color_space: ColorSpace,
722 pub output_transfer: TransferFunction, pub output_gamma: OutputGamma, pub enable_tonemapping: bool, pub tonemap_config: AgxConfig,
723}
724impl Default for ColorPipelineConfig {
725 fn default() -> Self {
726 Self { input_color_space: ColorSpace::Rec709, input_transfer: TransferFunction::Linear, output_color_space: ColorSpace::Rec709, output_transfer: TransferFunction::Rec709, output_gamma: OutputGamma::Bt1886, enable_tonemapping: true, tonemap_config: AgxConfig::default() }
727 }
728}
729impl ColorPipelineConfig {
730 pub fn broadcast() -> Self {
731 let mut config = AgxConfig::default(); config.in_gamut = Gamut::Rec709; config.in_transfer = Transfer::Linear;
732 config.working_curve = Transfer::AgxLogKraken; config.out_gamut = Gamut::Rec709; config.out_transfer = OutputTransfer::Bt1886InverseEotf;
733 config.toe_power = 3.0; config.shoulder_power = 3.25; config.slope = 2.0; config.working_mid_grey = 0.606060; config.log_output = false;
734 Self { input_color_space: ColorSpace::Rec709, input_transfer: TransferFunction::Linear, output_color_space: ColorSpace::Rec709, output_transfer: TransferFunction::Rec709, output_gamma: OutputGamma::Bt1886, enable_tonemapping: true, tonemap_config: config }
735 }
736 pub fn log_output(log_space: TransferFunction, gamut: ColorSpace) -> Self {
737 let mut config = AgxConfig::default(); config.in_gamut = Gamut::Rec709; config.in_transfer = Transfer::Linear;
738 config.working_curve = Transfer::AgxLogKraken;
739 config.out_gamut = match gamut {
740 ColorSpace::Rec709 => Gamut::Rec709, ColorSpace::Rec2020 => Gamut::Rec2020,
741 ColorSpace::DciP3 | ColorSpace::DisplayP3 => Gamut::P3D65, ColorSpace::SGamut3Cine => Gamut::SGamut3Cine,
742 ColorSpace::SGamut3 => Gamut::SGamut3, ColorSpace::ARRIWideGamut3 | ColorSpace::ARRIWideGamut4 => Gamut::Awg3,
743 ColorSpace::CanonCinemaGamut => Gamut::CanonCinema, ColorSpace::ACESAP1 => Gamut::Ap1,
744 ColorSpace::FGamut | ColorSpace::PanasonicVGamut => Gamut::Rwg, ColorSpace::FGamutC => Gamut::Ap0,
745 ColorSpace::DaVinciWideGamut => Gamut::DaVinciWg, _ => Gamut::Rec709,
746 };
747 config.out_transfer = OutputTransfer::Linear; config.log_output = true;
748 Self { input_color_space: ColorSpace::Rec709, input_transfer: TransferFunction::Linear, output_color_space: gamut, output_transfer: log_space, output_gamma: OutputGamma::Linear, enable_tonemapping: false, tonemap_config: config }
749 }
750}
751
752pub fn pipeline_convert_to_u16(pixels: &[f32]) -> Vec<u16> { pixels.iter().map(|&v| (v.clamp(0.0, 1.0) * 65535.0) as u16).collect() }
753
754pub fn highlight_clip(pixels: &mut [f32], threshold: f32) {
755 let range = 1.0 - threshold; if range <= 0.0 { return; }
756 for chunk in pixels.chunks_exact_mut(3) {
757 let r = chunk[0]; let g = chunk[1]; let b = chunk[2];
758 let max_val = r.max(g).max(b);
759 if max_val > threshold {
760 let t = ((max_val - threshold) / range).min(1.0);
761 chunk[0] = r + (max_val - r) * t; chunk[1] = g + (max_val - g) * t; chunk[2] = b + (max_val - b) * t;
762 }
763 }
764}
765
766pub fn normalize_linear(pixels: &mut [f32], black_level: f64, white_level: f64) {
767 let range = if white_level > black_level { white_level - black_level } else { 1.0 }; let inv_range = 1.0 / range;
768 for v in pixels.iter_mut() { *v = ((*v as f64 - black_level) * inv_range).clamp(0.0, 1.0) as f32; }
769}
770
771pub fn normalize_linear_f32(pixels: &mut [f32], black_level: f32, white_level: f32) {
772 let range = if white_level > black_level { white_level - black_level } else { 1.0 }; let inv_range = 1.0 / range;
773 pixels.par_iter_mut().for_each(|v| { *v = (*v - black_level) * inv_range; if *v < 0.0 { *v = 0.0; } else if *v > 1.0 { *v = 1.0; } });
774}
775
776pub fn normalize_linear_per_channel(rgb: &mut [f32], bl_r: f64, bl_g: f64, bl_b: f64, white_level: f64) {
785 let range_r = if white_level > bl_r { white_level - bl_r } else { 1.0 };
786 let range_g = if white_level > bl_g { white_level - bl_g } else { 1.0 };
787 let range_b = if white_level > bl_b { white_level - bl_b } else { 1.0 };
788 let inv_r = 1.0 / range_r;
789 let inv_g = 1.0 / range_g;
790 let inv_b = 1.0 / range_b;
791 rgb.par_chunks_exact_mut(3).for_each(|chunk| {
792 chunk[0] = ((chunk[0] as f64 - bl_r) * inv_r).clamp(0.0, 1.0) as f32;
793 chunk[1] = ((chunk[1] as f64 - bl_g) * inv_g).clamp(0.0, 1.0) as f32;
794 chunk[2] = ((chunk[2] as f64 - bl_b) * inv_b).clamp(0.0, 1.0) as f32;
795 });
796}
797
798pub fn bayer_phase_to_channel(x: u32, y: u32, pattern: BayerPattern) -> usize {
801 let even_x = x % 2 == 0;
802 let even_y = y % 2 == 0;
803 let is_red = match pattern {
804 BayerPattern::RGGB => even_x && even_y,
805 BayerPattern::BGGR => !even_x && !even_y,
806 BayerPattern::GRBG => !even_x && even_y,
807 BayerPattern::GBRG => even_x && !even_y,
808 _ => even_x && even_y, };
810 let is_blue = match pattern {
811 BayerPattern::RGGB => !even_x && !even_y,
812 BayerPattern::BGGR => even_x && even_y,
813 BayerPattern::GRBG => even_x && !even_y,
814 BayerPattern::GBRG => !even_x && even_y,
815 _ => !even_x && !even_y,
816 };
817 if is_red { return 0; }
818 if is_blue { return 3; }
819 if even_y { 1 } else { 2 }
820}
821
822fn interpolate_bilinear(channel_data: &[f32], grid_w: u32, grid_h: u32, u: f32, v: f32) -> f32 {
826 let fx = (u * (grid_w - 1) as f32).clamp(0.0, (grid_w - 1) as f32);
827 let fy = (v * (grid_h - 1) as f32).clamp(0.0, (grid_h - 1) as f32);
828 let ix = fx as usize;
829 let iy = fy as usize;
830 let frac_x = fx - ix as f32;
831 let frac_y = fy - iy as f32;
832
833 let w = grid_w as usize;
834 let get = |gx: usize, gy: usize| channel_data[gy.min(grid_h as usize - 1) * w + gx.min(grid_w as usize - 1)];
835
836 let g00 = get(ix, iy);
837 let g10 = get(ix + 1, iy);
838 let g01 = get(ix, iy + 1);
839 let g11 = get(ix + 1, iy + 1);
840
841 let top = g00 + (g10 - g00) * frac_x;
842 let bot = g01 + (g11 - g01) * frac_x;
843 top + (bot - top) * frac_y
844}
845
846pub fn compute_color_only_map(channels: &[Vec<f32>], grid_w: u32, grid_h: u32) -> Vec<Vec<f32>> {
849 let len = (grid_w * grid_h) as usize;
850 let mut color_map = vec![vec![0.0f32; len]; 4];
851 for i in 0..len {
852 let r = channels[0][i];
853 let g1 = channels[1][i];
854 let g2 = channels[2][i];
855 let b = channels[3][i];
856 let min_g = r.min(g1.min(g2.min(b)));
857 if min_g > 0.0 {
858 color_map[0][i] = r / min_g;
859 color_map[1][i] = g1 / min_g;
860 color_map[2][i] = g2 / min_g;
861 color_map[3][i] = b / min_g;
862 } else {
863 color_map[0][i] = 1.0;
864 color_map[1][i] = 1.0;
865 color_map[2][i] = 1.0;
866 color_map[3][i] = 1.0;
867 }
868 }
869 color_map
870}
871
872pub fn apply_lens_correction_cpu(
880 bayer: &mut [u16],
881 stride_width: u32,
882 offset_x: u32,
883 offset_y: u32,
884 pattern: BayerPattern,
885 shading_map_channels: &[Vec<f32>],
886 grid_w: u32,
887 grid_h: u32,
888 sensor_w: u32,
889 sensor_h: u32,
890 color_only: bool,
891 clamp_max: u16,
892) {
893 let (ox, oy) = (offset_x as f32, offset_y as f32);
894 let (sw, sh) = (sensor_w as f32, sensor_h as f32);
895
896 let channels = if color_only {
897 &compute_color_only_map(shading_map_channels, grid_w, grid_h)
898 } else {
899 shading_map_channels
900 };
901
902 let cm = clamp_max as u32;
903 bayer.par_chunks_exact_mut(stride_width as usize)
904 .enumerate()
905 .for_each(|(y, row)| {
906 let vy = (y as f32 + oy) / sh;
907 for (x, pixel) in row.iter_mut().enumerate() {
908 let vx = (x as f32 + ox) / sw;
909 let ch = bayer_phase_to_channel(x as u32, y as u32, pattern);
910 let gain = interpolate_bilinear(&channels[ch], grid_w, grid_h, vx, vy);
911 *pixel = ((*pixel as f32 * gain).round() as u32).min(cm) as u16;
912 }
913 });
914
915 if color_only {
916 let _ = channels;
917 }
918}
919
920pub fn apply_lens_correction_cpu_with_map(
928 bayer: &mut [u16],
929 stride_width: u32,
930 offset_x: u32,
931 offset_y: u32,
932 pattern: BayerPattern,
933 color_map: &[Vec<f32>],
934 grid_w: u32,
935 grid_h: u32,
936 sensor_w: u32,
937 sensor_h: u32,
938 src_black: [f32; 4],
939 src_white: f32,
940 extended_wl: u16,
941) {
942 let (ox, oy) = (offset_x as f32, offset_y as f32);
943 let (sw, sh) = (sensor_w as f32, sensor_h as f32);
944 let ew = extended_wl as u32;
945
946 bayer.par_chunks_exact_mut(stride_width as usize)
947 .enumerate()
948 .for_each(|(y, row)| {
949 let vy = (y as f32 + oy) / sh;
950 for (x, pixel) in row.iter_mut().enumerate() {
951 let vx = (x as f32 + ox) / sw;
952 let ch = bayer_phase_to_channel(x as u32, y as u32, pattern);
953 let gain = interpolate_bilinear(&color_map[ch], grid_w, grid_h, vx, vy);
954 let bl = src_black[ch];
955 let norm = (*pixel as f32 - bl) / (src_white - bl).max(f32::EPSILON);
956 let val = (norm * gain * ew as f32).round();
957 *pixel = (val as u32).min(ew) as u16;
958 }
959 });
960}
961
962#[cfg(test)]
963mod tests {
964 use super::*;
965
966 #[test]
969 fn detect_camera_to_xyz_picks_identity_when_input_is_identity() {
970 let id = [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0];
971 let out = detect_camera_to_xyz(&id);
972 for i in 0..9 {
973 assert!((out[i] - id[i]).abs() < 1e-5, "entry {} differs: {} vs {}", i, out[i], id[i]);
974 }
975 }
976
977 #[test]
981 fn detect_camera_to_xyz_prefers_forward_over_inverse() {
982 let m = [
989 D50_XYZ[0], 0.0, 0.0,
990 0.0, D50_XYZ[1], 0.0,
991 0.0, 0.0, D50_XYZ[2],
992 ];
993 let out = detect_camera_to_xyz(&m);
994 for i in 0..9 {
995 assert!((out[i] - m[i]).abs() < 1e-5, "entry {} differs: {} vs {}", i, out[i], m[i]);
996 }
997 }
998
999 #[test]
1002 fn hlg_knee_is_continuous_at_one_twelfth() {
1003 let below = TransferFunction::HLG.process_apply(1.0 / 12.0);
1004 let above = TransferFunction::HLG.process_apply(1.0 / 12.0 + 1e-4);
1005 let mid = (below + above) * 0.5;
1006 assert!((below - 0.5).abs() < 1e-4, "HLG at knee: {} (want 0.5)", below);
1007 assert!((above - 0.5).abs() < 5e-3, "HLG just above knee: {} (want ~0.5)", above);
1008 assert!((mid - 0.5).abs() < 5e-3, "HLG mid (knee avg): {}", mid);
1009 let a = TransferFunction::HLG.process_apply(0.001);
1011 let b = TransferFunction::HLG.process_apply(0.1);
1012 let c = TransferFunction::HLG.process_apply(0.8);
1013 assert!(a < b && b < c, "HLG must be monotonic: a={} b={} c={}", a, b, c);
1014 }
1015
1016 #[test]
1020 fn pq_forward_is_monotone_bounded() {
1021 let pf = |x: f32| {
1022 let x_m1 = x.powf(0.1593017578125_f32);
1023 ((0.8359375_f32 + 18.8515625_f32 * x_m1) / (1.0_f32 + 18.6875_f32 * x_m1)).powf(78.84375_f32)
1024 };
1025 for s in [0.0_f32, 0.01, 0.1, 0.18, 0.5, 1.0] {
1026 let v = pf(s);
1027 assert!(v.is_finite() && v >= 0.0 && v <= 1.0, "PQ({}) = {}", s, v);
1028 }
1029 let a = pf(0.10);
1031 let b = pf(0.18);
1032 let c = pf(0.50);
1033 assert!(a < b && b < c, "PQ must be monotonic: a={} b={} c={}", a, b, c);
1034 }
1035
1036 #[test]
1038 fn bradford_identity_for_same_white() {
1039 let m = build_bradford_matrix(&D65_XYZ, &D65_XYZ);
1040 for i in 0..9 {
1041 let expected = if i == 0 || i == 4 || i == 8 { 1.0 } else { 0.0 };
1042 assert!((m[i] - expected).abs() < 1e-4, "entry {}: {} (want {})", i, m[i], expected);
1043 }
1044 }
1045
1046 #[test]
1051 fn rec709_oetf_at_key_points() {
1052 let v_zero = TransferFunction::Rec709.process_apply(0.0);
1053 let v_low = TransferFunction::Rec709.process_apply(0.01);
1054 let v_knee = TransferFunction::Rec709.process_apply(0.018);
1055 let v_high = TransferFunction::Rec709.process_apply(0.5);
1056 let v_one = TransferFunction::Rec709.process_apply(1.0);
1057 assert!(v_zero.abs() < 1e-6, "Rec.709 at 0 = {}", v_zero);
1058 assert!((v_low - 0.045).abs() < 1e-4, "Rec.709 at 0.01 = {}", v_low);
1060 let power_at_knee = 1.099_f32 * 0.018_f32.powf(0.45) - 0.099;
1064 assert!((v_knee - power_at_knee).abs() < 1e-4, "Rec.709 at 0.018 = {}", v_knee);
1065 assert!((v_one - 1.0).abs() < 1e-4, "Rec.709 at 1.0 = {}", v_one);
1067 assert!(v_zero < v_low && v_low < v_knee && v_knee < v_high && v_high < v_one,
1069 "Rec.709 must be monotonic");
1070 let power_high = 1.099_f32 * 0.5_f32.powf(0.45) - 0.099;
1072 assert!((v_high - power_high).abs() < 1e-4, "Rec.709 at 0.5 = {} (power={})", v_high, power_high);
1073 }
1074
1075 #[test]
1079 fn vlog_at_key_points() {
1080 let v_knee = TransferFunction::VLog.process_apply(0.01);
1081 assert!((v_knee - 0.181).abs() < 1e-4, "V-Log at knee = {} (want 0.181)", v_knee);
1083 let v_one = TransferFunction::VLog.process_apply(1.0);
1084 let expected = 0.241514_f32 * (1.0_f32 + 0.00873_f32).log10() + 0.598206_f32;
1086 assert!((v_one - expected).abs() < 1e-3, "V-Log at 1.0 = {} (want {})", v_one, expected);
1087 }
1088
1089 #[test]
1093 fn arri_logc3_at_key_points() {
1094 let v_one = TransferFunction::ARRIlog3.process_apply(1.0);
1095 let expected = 0.247190_f32 * (5.555556_f32 + 0.052272_f32).log10() + 0.385537_f32;
1096 assert!((v_one - expected).abs() < 1e-3, "ARRI LogC3 at 1.0 = {} (want {})", v_one, expected);
1097 let v_low = TransferFunction::ARRIlog3.process_apply(0.0);
1098 assert!((v_low - 0.092809).abs() < 1e-4, "ARRI LogC3 at 0 = {} (want 0.092809)", v_low);
1100 }
1101
1102 #[test]
1106 fn arri_logc4_at_key_points() {
1107 use crate::color::{arri_logc4_constants, arri_logc4_eotf, arri_logc4_oetf};
1108 let (a, b, c, s, t) = arri_logc4_constants();
1112 assert!((a - 2231.8263091).abs() < 1e-3, "a = {} (want 2231.8263)", a);
1113 assert!((b - 0.90713587).abs() < 1e-6, "b = {} (want 0.9071)", b);
1114 assert!((c - 0.09286413).abs() < 1e-6, "c = {} (want 0.0929)", c);
1115 assert!((s - 0.1135972).abs() < 1e-5, "s = {} (want 0.1135972)", s);
1116 assert!((t - (-0.0180570)).abs() < 1e-5, "t = {} (want -0.0180570)", t);
1117
1118 let v_18 = arri_logc4_oetf(0.18);
1120 assert!((v_18 - 0.2783958).abs() < 1e-5, "LogC4 OETF(0.18) = {} (want 0.2783958)", v_18);
1121
1122 let v_one = arri_logc4_oetf(1.0);
1125 let expected_one = (((a * 1.0 + 64.0).log2() - 6.0) / 14.0) * b + c;
1126 assert!((v_one - expected_one).abs() < 1e-5, "LogC4 OETF(1.0) = {} (want {})", v_one, expected_one);
1127 assert!((v_one - 0.4275194).abs() < 1e-5, "LogC4 OETF(1.0) = {} (want 0.4275194)", v_one);
1128
1129 let v_below = arri_logc4_oetf(t - 0.001);
1131 let expected_below = (t - 0.001 - t) / s; assert!((v_below - expected_below).abs() < 1e-5, "LogC4 linear branch");
1133
1134 let rt = arri_logc4_eotf(v_18);
1136 assert!((rt - 0.18).abs() < 1e-4, "LogC4 round-trip: encode→decode(0.18) = {} (want 0.18)", rt);
1137
1138 for x in [0.001_f32, 0.01, 0.1, 0.5, 2.0, 10.0] {
1140 let enc = arri_logc4_oetf(x);
1141 let dec = arri_logc4_eotf(enc);
1142 assert!((dec - x).abs() < 1e-4, "LogC4 round-trip at x={}: encode→decode = {} (want {})", x, dec, x);
1143 }
1144
1145 let v_18_full = TransferFunction::ARRIlog4.process_apply(0.18);
1148 assert!((v_18_full - v_18).abs() < 1e-5, "TransferFunction::ARRIlog4 disagrees with arri_logc4_oetf: {} vs {}", v_18_full, v_18);
1149 }
1150
1151 #[test]
1162 fn slog3_canonical_at_key_points() {
1163 let v_low = TransferFunction::SLog3.process_apply(0.009);
1164 let v_at = TransferFunction::SLog3.process_apply(0.01125);
1165 let v_high = TransferFunction::SLog3.process_apply(0.013);
1166 assert!(v_low.is_finite() && v_at.is_finite() && v_high.is_finite());
1167 assert!(v_low < v_high, "S-Log3 must be monotonic across the knee: low={} high={}", v_low, v_high);
1168 let v_18 = TransferFunction::SLog3.process_apply(0.18);
1171 assert!((v_18 - 0.4106).abs() < 0.01, "S-Log3 at 0.18 = {} (want ~0.4106)", v_18);
1172 let v_1 = TransferFunction::SLog3.process_apply(1.0);
1174 assert!((v_1 - 0.596).abs() < 0.02, "S-Log3 at 1.0 = {} (want ~0.596)", v_1);
1175 let v_0 = TransferFunction::SLog3.process_apply(0.0);
1177 assert!((v_0 - 0.0929).abs() < 0.001, "S-Log3 at 0 = {} (want ~0.0929)", v_0);
1178 }
1179}
1180
1181impl TransferFunction {
1186 #[cfg(test)]
1187 fn process_apply(&self, x: f32) -> f32 {
1188 match self {
1189 TransferFunction::Linear => x,
1190 TransferFunction::Rec709 => rec709_oetf(x).min(1.0).max(0.0),
1191 TransferFunction::SLog3 => if x >= 0.01125_f32 { (420.0_f32 + 261.5_f32 * ((x + 0.01_f32) / 0.19_f32).log10()) / 1023.0_f32 } else { (x * (171.2102946929_f32 - 95.0_f32) / 0.01125_f32 + 95.0_f32) / 1023.0_f32 },
1192 TransferFunction::VLog => if x < 0.01 { 5.6_f32 * x + 0.125_f32 } else { 0.241514_f32 * (x + 0.00873_f32).log10() + 0.598206_f32 },
1193 TransferFunction::ARRIlog3 => if x > 0.010591_f32 { 0.247190_f32 * (5.555556_f32 * x + 0.052272_f32).log10() + 0.385537_f32 } else { 5.367655_f32 * x + 0.092809_f32 },
1194 TransferFunction::ARRIlog4 => {
1195 let (a, b, c, s, t) = crate::color::arri_logc4_constants();
1196 if x >= t { ((a * x + 64.0_f32).log2() - 6.0_f32) / 14.0_f32 * b + c } else { (x - t) / s }
1197 },
1198 TransferFunction::CLog3 => {
1199 let neg_graft_lin = (0.097465473_f32 - 0.12512219_f32) / 1.9754798_f32;
1200 let pos_graft_lin = (0.15277891_f32 - 0.12512219_f32) / 1.9754798_f32;
1201 if x < neg_graft_lin { -0.36726845_f32 * ((-x * 14.98325_f32 + 1.0_f32).max(1e-10_f32)).log10() + 0.12783901_f32 }
1202 else if x <= pos_graft_lin { 1.9754798_f32 * x + 0.12512219_f32 }
1203 else { 0.36726845_f32 * (x * 14.98325_f32 + 1.0_f32).log10() + 0.12240537_f32 }
1204 }
1205 TransferFunction::FLog2 => if x >= 0.000889_f32 { 0.245281_f32 * (5.555556_f32 * x + 0.064829_f32).log10() + 0.384316_f32 } else { 8.799461_f32 * x + 0.092864_f32 },
1206 TransferFunction::AppleLog | TransferFunction::AppleLog2 => {
1207 const R0: f32 = -0.05641088; const RT: f32 = 0.01; const C: f32 = 47.28711236;
1208 const BETA: f32 = 0.00964052; const GAMMA: f32 = 0.08550479; const DELTA: f32 = 0.69336945;
1209 if x < R0 { 0.0 } else if x < RT { C * (x - R0) * (x - R0) } else { GAMMA * (x + BETA).log2() + DELTA }
1210 }
1211 TransferFunction::ACESCCT => if x > 0.0078125_f32 { (x.log2() + 9.72_f32) / 17.52_f32 } else { 10.5402377416545_f32 * x + 0.0729055341958355_f32 },
1212 TransferFunction::PQ => { let x_m1 = x.powf(0.1593017578125_f32); ((0.8359375_f32 + 18.8515625_f32 * x_m1) / (1.0_f32 + 18.6875_f32 * x_m1)).powf(78.84375_f32) }
1213 TransferFunction::HLG => if x < (1.0_f32 / 12.0_f32) { (3.0_f32 * x).sqrt() } else { 0.17883277_f32 * (12.0_f32 * x - 0.28466892_f32).ln() + 0.55991073_f32 },
1214 TransferFunction::DaVinciIntermediate => if x <= 0.00262409_f32 { x * 10.44426855_f32 } else { 0.07329248_f32 * ((x + 0.0075_f32).log2() + 7.0_f32) },
1215 TransferFunction::Gamma24 => x.max(0.0).powf(1.0 / 2.4),
1216 }
1217 }
1218}
1219
1220#[cfg(test)]
1224mod lens_tests {
1225 use super::*;
1226
1227 #[test]
1228 fn bayer_phase_to_channel_rggb() {
1229 let p = BayerPattern::RGGB;
1230 assert_eq!(bayer_phase_to_channel(0, 0, p), 0);
1232 assert_eq!(bayer_phase_to_channel(1, 0, p), 1);
1234 assert_eq!(bayer_phase_to_channel(0, 1, p), 2);
1236 assert_eq!(bayer_phase_to_channel(1, 1, p), 3);
1238 }
1239
1240 #[test]
1241 fn bayer_phase_to_channel_bggr() {
1242 let p = BayerPattern::BGGR;
1243 assert_eq!(bayer_phase_to_channel(1, 1, p), 0); assert_eq!(bayer_phase_to_channel(0, 0, p), 3); }
1246
1247 #[test]
1248 fn bayer_phase_to_channel_grbg() {
1249 let p = BayerPattern::GRBG;
1250 assert_eq!(bayer_phase_to_channel(1, 0, p), 0); assert_eq!(bayer_phase_to_channel(0, 1, p), 3); }
1253
1254 #[test]
1255 fn bayer_phase_to_channel_gbrg() {
1256 let p = BayerPattern::GBRG;
1257 assert_eq!(bayer_phase_to_channel(0, 1, p), 0); assert_eq!(bayer_phase_to_channel(1, 0, p), 3); }
1260
1261 #[test]
1262 fn interpolate_bilinear_identity_map_returns_center_value() {
1263 let w = 3u32; let h = 3u32;
1264 let data: Vec<f32> = vec![
1265 1.0f32, 1.5f32, 1.0f32,
1266 1.5f32, 2.0f32, 1.5f32,
1267 1.0f32, 1.5f32, 1.0f32,
1268 ];
1269 let result = interpolate_bilinear(&data, w, h, 0.5f32, 0.5f32);
1270 assert!((result - 2.0f32).abs() < 1e-5f32, "center={}", result);
1271 }
1272
1273 #[test]
1274 fn interpolate_bilinear_corner_returns_edge_value() {
1275 let w = 2u32; let h = 2u32;
1276 let data: Vec<f32> = vec![1.0f32, 2.0f32, 3.0f32, 4.0f32];
1277 let result = interpolate_bilinear(&data, w, h, 0.0f32, 0.0f32);
1278 assert!((result - 1.0f32).abs() < 1e-5f32, "topleft={}", result);
1279 let result = interpolate_bilinear(&data, w, h, 1.0f32, 1.0f32);
1280 assert!((result - 4.0f32).abs() < 1e-5f32, "botright={}", result);
1281 }
1282
1283 #[test]
1284 fn compute_color_only_map_uniform_returns_identity() {
1285 let w = 2u32; let h = 2u32;
1286 let channels = vec![
1287 vec![2.0f32; 4],
1288 vec![2.0f32; 4],
1289 vec![2.0f32; 4],
1290 vec![2.0f32; 4],
1291 ];
1292 let result = compute_color_only_map(&channels, w, h);
1293 for ch in &result {
1294 for v in ch {
1295 assert!((*v - 1.0f32).abs() < 1e-5f32, "color_only should be 1.0, got {}", v);
1296 }
1297 }
1298 }
1299
1300 #[test]
1301 fn compute_color_only_map_different_channels_preserves_ratio() {
1302 let w = 1u32; let h = 1u32;
1303 let channels = vec![
1304 vec![4.0f32],
1305 vec![2.0f32],
1306 vec![2.0f32],
1307 vec![4.0f32],
1308 ];
1309 let result = compute_color_only_map(&channels, w, h);
1310 assert!((result[0][0] - 2.0f32).abs() < 1e-5f32, "R={}", result[0][0]);
1311 assert!((result[1][0] - 1.0f32).abs() < 1e-5f32, "G1={}", result[1][0]);
1312 assert!((result[2][0] - 1.0f32).abs() < 1e-5f32, "G2={}", result[2][0]);
1313 assert!((result[3][0] - 2.0f32).abs() < 1e-5f32, "B={}", result[3][0]);
1314 }
1315
1316 #[test]
1317 fn normalize_linear_per_channel_basic() {
1318 let mut rgb = vec![1000.0f32, 2000.0f32, 1500.0f32];
1319 normalize_linear_per_channel(&mut rgb, 0.0f64, 0.0f64, 0.0f64, 4000.0f64);
1320 assert!((rgb[0] - 0.25f32).abs() < 1e-5f32, "R={}", rgb[0]);
1321 assert!((rgb[1] - 0.5f32).abs() < 1e-5f32, "G={}", rgb[1]);
1322 assert!((rgb[2] - 0.375f32).abs() < 1e-5f32, "B={}", rgb[2]);
1323 }
1324
1325 #[test]
1326 fn normalize_linear_per_channel_per_channel_bl() {
1327 let mut rgb = vec![1000.0f32, 2000.0f32, 1500.0f32];
1328 normalize_linear_per_channel(&mut rgb, 100.0f64, 200.0f64, 50.0f64, 2000.0f64);
1329 let r_exp = (1000.0f64 - 100.0f64) / (2000.0f64 - 100.0f64);
1330 let g_exp = (2000.0f64 - 200.0f64) / (2000.0f64 - 200.0f64);
1331 let b_exp = (1500.0f64 - 50.0f64) / (2000.0f64 - 50.0f64);
1332 assert!((rgb[0] - r_exp as f32).abs() < 1e-5f32, "R={}", rgb[0]);
1333 assert!((rgb[1] - g_exp as f32).abs() < 1e-5f32, "G={}", rgb[1]);
1334 assert!((rgb[2] - b_exp as f32).abs() < 1e-5f32, "B={}", rgb[2]);
1335 }
1336
1337 #[test]
1338 fn apply_lens_correction_identity_map_preserves_pixels() {
1339 let w = 4u32; let h = 4u32;
1340 let mut bayer: Vec<u16> = (0u16..w as u16 * h as u16).collect();
1341 let original = bayer.clone();
1342 let channels = vec![vec![1.0f32; (w * h) as usize]; 4];
1343 apply_lens_correction_cpu_with_map(
1344 &mut bayer, w, 0, 0, BayerPattern::RGGB,
1345 &channels, 2, 2, w, h,
1346 [0.0; 4], 65535.0, 65535,
1347 );
1348 for (i, (&orig, &new)) in original.iter().zip(bayer.iter()).enumerate() {
1349 assert_eq!(orig, new, "pixel {} should be unchanged", i);
1350 }
1351 }
1352
1353 #[test]
1354 fn apply_lens_correction_uniform_gain_scales_correctly() {
1355 let w = 4u32; let h = 4u32;
1356 let mut bayer: Vec<u16> = vec![100u16; (w * h) as usize];
1357 let channels = vec![vec![2.0f32; (w * h) as usize]; 4];
1358 apply_lens_correction_cpu_with_map(
1359 &mut bayer, w, 0, 0, BayerPattern::RGGB,
1360 &channels, 2, 2, w, h,
1361 [0.0; 4], 65535.0, 65535,
1362 );
1363 for (i, &p) in bayer.iter().enumerate() {
1364 assert_eq!(p, 200u16, "pixel {} should be 200, got {}", i, p);
1365 }
1366 }
1367}