mixflow_LS_optimization.m 666 B

12345678910111213141516
  1. function ssr=mixflow_LS_optimization(coef,flowfield)
  2. flowfield_pos = flowfield(:,1);
  3. flowfield_vec = flowfield(:,2);
  4. valid_flowfield_idx = norm(flowfield_vec)>0;
  5. rot_axis = normalize(floQ(coef(1,2:4)));
  6. rot_scale = coef(1,1);
  7. fit_rotField = -rot_axis.Qcross(flowfield_pos).*rot_scale; % Rotation Field
  8. trans_axis = normalize(floQ(coef(2,2:4)));
  9. trans_scale = coef(2,1);
  10. fit_transField = (trans_axis+flowfield_pos.*trans_axis.*flowfield_pos)./2.*trans_scale; % Translational Field
  11. fit_mixField = fit_transField+fit_rotField;
  12. residue= fit_mixField(valid_flowfield_idx).Qangle(flowfield_vec(valid_flowfield_idx));
  13. ssr = sum(residue.^2);