use ndarray::Array2;
use std::sync::Arc;
use crate::rho_optimizer::RhoBlockAdditiveHessian;
use gam_problem::OuterStrategyError;
pub use gam_problem::HessianValue;
pub fn add_rho_block_dense_to_hessian(
hessian: &mut HessianValue,
rho_block: &Array2<f64>,
) -> Result<(), String> {
if rho_block.nrows() != rho_block.ncols() {
return Err(OuterStrategyError::RhoBlockShape {
reason: format!(
"rho-block Hessian update must be square, got {}x{}",
rho_block.nrows(),
rho_block.ncols()
),
}
.into());
}
match hessian {
HessianValue::Dense(h) => {
if rho_block.nrows() > h.nrows() || rho_block.ncols() > h.ncols() {
return Err(OuterStrategyError::RhoBlockShape {
reason: format!(
"rho-block Hessian update shape mismatch: got {}x{}, outer Hessian is {}x{}",
rho_block.nrows(),
rho_block.ncols(),
h.nrows(),
h.ncols()
),
}
.into());
}
let k = rho_block.nrows();
let mut sl = h.slice_mut(ndarray::s![..k, ..k]);
sl += rho_block;
Ok(())
}
HessianValue::Operator(op) => {
let base = Arc::clone(op);
let dim = base.dim();
if rho_block.nrows() > dim {
return Err(OuterStrategyError::RhoBlockShape {
reason: format!(
"rho-block Hessian update dimension mismatch: got {}x{}, operator dim is {}",
rho_block.nrows(),
rho_block.ncols(),
dim
),
}
.into());
}
*hessian = HessianValue::Operator(Arc::new(RhoBlockAdditiveHessian {
base,
rho_block: rho_block.clone(),
dim,
}));
Ok(())
}
HessianValue::Unavailable => Ok(()),
}
}