{"id":110129,"date":"2026-09-26T06:49:04","date_gmt":"2026-09-25T22:49:04","guid":{"rendered":"https:\/\/www.wsisp.com\/helps\/110129.html"},"modified":"2026-09-26T06:49:04","modified_gmt":"2026-09-25T22:49:04","slug":"c%e4%bb%a3%e7%a0%81%e5%ae%9e%e7%8e%b0matlab%e4%b8%ad%e7%9a%84lsqnonlin%e5%87%bd%e6%95%b0%e5%8a%9f%e8%83%bd","status":"publish","type":"post","link":"https:\/\/www.wsisp.com\/helps\/110129.html","title":{"rendered":"C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd"},"content":{"rendered":"<p>                    <span class=\"token comment\">\/\/ &#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;<\/span><br \/>\n<span class=\"token comment\">\/\/  lsqnonlin.cpp<\/span><br \/>\n<span class=\"token comment\">\/\/  MATLAB \u9ed8\u8ba4\u7b97\u6cd5 trust-region-reflective \u7684\u72ec\u7acb\u5b9e\u73b0<\/span><br \/>\n<span class=\"token comment\">\/\/  \u7f16\u8bd1: g&#043;&#043; -O2 -std&#061;c&#043;&#043;17 lsqnonlin_trr.cpp -o lsqtrr<\/span><br \/>\n<span class=\"token comment\">\/\/ &#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;<\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;cstdio&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;cmath&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;vector&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;functional&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;algorithm&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;limits&gt;<\/span><\/span><\/p>\n<p><span class=\"token keyword\">using<\/span> Vec <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span>vector<span class=\"token operator\">&lt;<\/span><span class=\"token keyword\">double<\/span><span class=\"token operator\">&gt;<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p><span class=\"token keyword\">struct<\/span> <span class=\"token class-name\">Matrix<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token keyword\">int<\/span> rows <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> cols <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    std<span class=\"token double-colon punctuation\">::<\/span>vector<span class=\"token operator\">&lt;<\/span><span class=\"token keyword\">double<\/span><span class=\"token operator\">&gt;<\/span> a<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token function\">Matrix<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token keyword\">default<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token function\">Matrix<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> r<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">int<\/span> c<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">:<\/span> <span class=\"token function\">rows<\/span><span class=\"token punctuation\">(<\/span>r<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token function\">cols<\/span><span class=\"token punctuation\">(<\/span>c<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token function\">a<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">(<\/span>size_t<span class=\"token punctuation\">)<\/span>r<span class=\"token operator\">*<\/span>c<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><span class=\"token punctuation\">}<\/span><br \/>\n    <span class=\"token keyword\">double<\/span><span class=\"token operator\">&amp;<\/span>       <span class=\"token keyword\">operator<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">int<\/span> j<span class=\"token punctuation\">)<\/span>       <span class=\"token punctuation\">{<\/span> <span class=\"token keyword\">return<\/span> a<span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">(<\/span>size_t<span class=\"token punctuation\">)<\/span>i<span class=\"token operator\">*<\/span>cols <span class=\"token operator\">&#043;<\/span> j<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><br \/>\n    <span class=\"token keyword\">double<\/span>        <span class=\"token keyword\">operator<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">int<\/span> j<span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">const<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token keyword\">return<\/span> a<span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">(<\/span>size_t<span class=\"token punctuation\">)<\/span>i<span class=\"token operator\">*<\/span>cols <span class=\"token operator\">&#043;<\/span> j<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p><span class=\"token keyword\">static<\/span> <span class=\"token keyword\">double<\/span> <span class=\"token function\">dot<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> a<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> b<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token keyword\">double<\/span> s <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span>size_t i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> a<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> s <span class=\"token operator\">&#043;&#061;<\/span> a<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token operator\">*<\/span>b<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token keyword\">return<\/span> s<span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><br \/>\n<span class=\"token keyword\">static<\/span> <span class=\"token keyword\">double<\/span> <span class=\"token function\">nrm2<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> a<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token keyword\">return<\/span> <span class=\"token function\">dot<\/span><span class=\"token punctuation\">(<\/span>a<span class=\"token punctuation\">,<\/span> a<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><br \/>\n<span class=\"token keyword\">static<\/span> <span class=\"token keyword\">double<\/span> <span class=\"token function\">norm<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> a<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token keyword\">return<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">sqrt<\/span><span class=\"token punctuation\">(<\/span><span class=\"token function\">dot<\/span><span class=\"token punctuation\">(<\/span>a<span class=\"token punctuation\">,<\/span> a<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ &#8212;&#8212;&#8212;- LDLT \u6c42\u89e3\u5bf9\u79f0\u7cfb\u7edf A x &#061; b &#8212;&#8212;&#8212;-<\/span><br \/>\n<span class=\"token keyword\">static<\/span> <span class=\"token keyword\">bool<\/span> <span class=\"token function\">ldltSolve<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Matrix<span class=\"token operator\">&amp;<\/span> A<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> b<span class=\"token punctuation\">,<\/span> Vec<span class=\"token operator\">&amp;<\/span> x<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token keyword\">const<\/span> <span class=\"token keyword\">int<\/span> n <span class=\"token operator\">&#061;<\/span> A<span class=\"token punctuation\">.<\/span>rows<span class=\"token punctuation\">;<\/span><br \/>\n    Matrix <span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">,<\/span> n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    Vec <span class=\"token function\">D<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> j <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> j <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>j<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> d <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">A<\/span><span class=\"token punctuation\">(<\/span>j<span class=\"token punctuation\">,<\/span> j<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> j<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span> d <span class=\"token operator\">-&#061;<\/span> <span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>j<span class=\"token punctuation\">,<\/span> k<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span><span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>j<span class=\"token punctuation\">,<\/span> k<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>D<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token operator\">!<\/span>std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">isfinite<\/span><span class=\"token punctuation\">(<\/span>d<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">||<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">abs<\/span><span class=\"token punctuation\">(<\/span>d<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&lt;<\/span> <span class=\"token number\">1e-300<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">return<\/span> <span class=\"token boolean\">false<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        D<span class=\"token punctuation\">[<\/span>j<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> d<span class=\"token punctuation\">;<\/span> <span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>j<span class=\"token punctuation\">,<\/span> j<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">1.0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> j<span class=\"token operator\">&#043;<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n            <span class=\"token keyword\">double<\/span> s <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">A<\/span><span class=\"token punctuation\">(<\/span>i<span class=\"token punctuation\">,<\/span> j<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> j<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span> s <span class=\"token operator\">-&#061;<\/span> <span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>i<span class=\"token punctuation\">,<\/span> k<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span><span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>j<span class=\"token punctuation\">,<\/span> k<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>D<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>i<span class=\"token punctuation\">,<\/span> j<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> s <span class=\"token operator\">\/<\/span> D<span class=\"token punctuation\">[<\/span>j<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token operator\">!<\/span>std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">isfinite<\/span><span class=\"token punctuation\">(<\/span><span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>i<span class=\"token punctuation\">,<\/span> j<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">return<\/span> <span class=\"token boolean\">false<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token punctuation\">}<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><br \/>\n    Vec <span class=\"token function\">y<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> s <span class=\"token operator\">&#061;<\/span> b<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> i<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span> s <span class=\"token operator\">-&#061;<\/span> <span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>i<span class=\"token punctuation\">,<\/span> k<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>y<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        y<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> s<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><br \/>\n    Vec <span class=\"token function\">z<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> z<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> y<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token operator\">\/<\/span>D<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    x<span class=\"token punctuation\">.<\/span><span class=\"token function\">assign<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> n<span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&gt;&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#8212;<\/span>i<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> s <span class=\"token operator\">&#061;<\/span> z<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> i<span class=\"token operator\">&#043;<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span> s <span class=\"token operator\">-&#061;<\/span> <span class=\"token function\">L<\/span><span class=\"token punctuation\">(<\/span>k<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>x<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        x<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> s<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">double<\/span> v <span class=\"token operator\">:<\/span> x<span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token operator\">!<\/span>std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">isfinite<\/span><span class=\"token punctuation\">(<\/span>v<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">return<\/span> <span class=\"token boolean\">false<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">return<\/span> <span class=\"token boolean\">true<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ &#8212;&#8212;&#8212;- \u8ba1\u7b97 JtJ \u4e0e Jtf &#8212;&#8212;&#8212;-<\/span><br \/>\n<span class=\"token keyword\">static<\/span> <span class=\"token keyword\">void<\/span> <span class=\"token function\">jtj_jtf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Matrix<span class=\"token operator\">&amp;<\/span> J<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> f<span class=\"token punctuation\">,<\/span> Matrix<span class=\"token operator\">&amp;<\/span> JtJ<span class=\"token punctuation\">,<\/span> Vec<span class=\"token operator\">&amp;<\/span> Jtf<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token keyword\">int<\/span> m <span class=\"token operator\">&#061;<\/span> J<span class=\"token punctuation\">.<\/span>rows<span class=\"token punctuation\">,<\/span> n <span class=\"token operator\">&#061;<\/span> J<span class=\"token punctuation\">.<\/span>cols<span class=\"token punctuation\">;<\/span><br \/>\n    JtJ <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">Matrix<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">,<\/span> n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    Jtf<span class=\"token punctuation\">.<\/span><span class=\"token function\">assign<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> m<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span> Jtf<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#043;&#061;<\/span> <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>k<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>f<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> j <span class=\"token operator\">&#061;<\/span> i<span class=\"token punctuation\">;<\/span> j <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>j<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n            <span class=\"token keyword\">double<\/span> s <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> m<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span> s <span class=\"token operator\">&#043;&#061;<\/span> <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>k<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span><span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>k<span class=\"token punctuation\">,<\/span> j<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token function\">JtJ<\/span><span class=\"token punctuation\">(<\/span>i<span class=\"token punctuation\">,<\/span> j<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">JtJ<\/span><span class=\"token punctuation\">(<\/span>j<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> s<span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token punctuation\">}<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ &#8212;&#8212;&#8212;- \u9ad8\u65af-\u725b\u987f\u6b65 &#8212;&#8212;&#8212;-<\/span><br \/>\n<span class=\"token keyword\">static<\/span> <span class=\"token keyword\">bool<\/span> <span class=\"token function\">gaussNewtonStep<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Matrix<span class=\"token operator\">&amp;<\/span> J<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> f<span class=\"token punctuation\">,<\/span> Vec<span class=\"token operator\">&amp;<\/span> s<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    Matrix JtJ<span class=\"token punctuation\">;<\/span> Vec Jtf<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token function\">jtj_jtf<\/span><span class=\"token punctuation\">(<\/span>J<span class=\"token punctuation\">,<\/span> f<span class=\"token punctuation\">,<\/span> JtJ<span class=\"token punctuation\">,<\/span> Jtf<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> JtJ<span class=\"token punctuation\">.<\/span>rows<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> <span class=\"token function\">JtJ<\/span><span class=\"token punctuation\">(<\/span>i<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#043;&#061;<\/span> <span class=\"token number\">1e-14<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    Vec <span class=\"token function\">rhs<\/span><span class=\"token punctuation\">(<\/span>JtJ<span class=\"token punctuation\">.<\/span>rows<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> JtJ<span class=\"token punctuation\">.<\/span>rows<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> rhs<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">&#8211;<\/span>Jtf<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">return<\/span> <span class=\"token function\">ldltSolve<\/span><span class=\"token punctuation\">(<\/span>JtJ<span class=\"token punctuation\">,<\/span> rhs<span class=\"token punctuation\">,<\/span> s<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ &#8212;&#8212;&#8212;- Dogleg \u5b50\u95ee\u9898&#xff1a;\u5728 \u2016s\u2016 \u2264 \u0394 \u5185 min \u2016J s &#043; f\u2016 &#8212;&#8212;&#8212;-<\/span><br \/>\n<span class=\"token keyword\">static<\/span> Vec <span class=\"token function\">solveTrustRegion<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Matrix<span class=\"token operator\">&amp;<\/span> J<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> f<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">double<\/span> Delta<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token keyword\">const<\/span> <span class=\"token keyword\">int<\/span> m <span class=\"token operator\">&#061;<\/span> J<span class=\"token punctuation\">.<\/span>rows<span class=\"token punctuation\">,<\/span> n <span class=\"token operator\">&#061;<\/span> J<span class=\"token punctuation\">.<\/span>cols<span class=\"token punctuation\">;<\/span><br \/>\n    Vec s_gn<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">bool<\/span> okGN <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">gaussNewtonStep<\/span><span class=\"token punctuation\">(<\/span>J<span class=\"token punctuation\">,<\/span> f<span class=\"token punctuation\">,<\/span> s_gn<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>okGN <span class=\"token operator\">&amp;&amp;<\/span> <span class=\"token function\">norm<\/span><span class=\"token punctuation\">(<\/span>s_gn<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&lt;&#061;<\/span> Delta<span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">return<\/span> s_gn<span class=\"token punctuation\">;<\/span>   <span class=\"token comment\">\/\/ GN \u6b65\u5728\u57df\u5185<\/span><\/p>\n<p>    <span class=\"token comment\">\/\/ Cauchy \u70b9<\/span><br \/>\n    Vec <span class=\"token function\">g<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> m<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span> g<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#043;&#061;<\/span> <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>k<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>f<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">double<\/span> gg <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">dot<\/span><span class=\"token punctuation\">(<\/span>g<span class=\"token punctuation\">,<\/span> g<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>gg <span class=\"token operator\">&lt;<\/span> <span class=\"token number\">1e-300<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">return<\/span> <span class=\"token function\">Vec<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>    Vec <span class=\"token function\">Jg<\/span><span class=\"token punctuation\">(<\/span>m<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> m<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> Jg<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#043;&#061;<\/span> <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>k<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>g<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">double<\/span> JgJg <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">dot<\/span><span class=\"token punctuation\">(<\/span>Jg<span class=\"token punctuation\">,<\/span> Jg<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>JgJg <span class=\"token operator\">&lt;<\/span> <span class=\"token number\">1e-300<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">return<\/span> <span class=\"token function\">Vec<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>    <span class=\"token keyword\">double<\/span> alpha <span class=\"token operator\">&#061;<\/span> gg <span class=\"token operator\">\/<\/span> JgJg<span class=\"token punctuation\">;<\/span><br \/>\n    Vec <span class=\"token function\">s_sd<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> s_sd<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">&#8211;<\/span>alpha <span class=\"token operator\">*<\/span> g<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>    <span class=\"token keyword\">double<\/span> nsd <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">norm<\/span><span class=\"token punctuation\">(<\/span>s_sd<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>nsd <span class=\"token operator\">&gt;&#061;<\/span> Delta <span class=\"token operator\">||<\/span> <span class=\"token operator\">!<\/span>okGN<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span>          <span class=\"token comment\">\/\/ SD \u6b65\u51fa\u754c&#xff08;\u6216 GN \u4e0d\u53ef\u7528&#xff09;\u2192 \u7f29\u653e\u5230\u8fb9\u754c<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> sc <span class=\"token operator\">&#061;<\/span> Delta <span class=\"token operator\">\/<\/span> nsd<span class=\"token punctuation\">;<\/span><br \/>\n        Vec <span class=\"token function\">s<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> s<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> sc <span class=\"token operator\">*<\/span> s_sd<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">return<\/span> s<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><\/p>\n<p>    <span class=\"token comment\">\/\/ Dogleg \u63d2\u503c&#xff1a;\u03c4 \u4f7f \u2016s_sd &#043; \u03c4(s_gn &#8211; s_sd)\u2016 &#061; \u0394<\/span><br \/>\n    Vec <span class=\"token function\">d<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> d<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> s_gn<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#8211;<\/span> s_sd<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">double<\/span> a2 <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">dot<\/span><span class=\"token punctuation\">(<\/span>d<span class=\"token punctuation\">,<\/span> d<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">double<\/span> b2 <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">2.0<\/span> <span class=\"token operator\">*<\/span> <span class=\"token function\">dot<\/span><span class=\"token punctuation\">(<\/span>s_sd<span class=\"token punctuation\">,<\/span> d<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">double<\/span> c2 <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">dot<\/span><span class=\"token punctuation\">(<\/span>s_sd<span class=\"token punctuation\">,<\/span> s_sd<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#8211;<\/span> Delta<span class=\"token operator\">*<\/span>Delta<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">double<\/span> disc <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">max<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">0.0<\/span><span class=\"token punctuation\">,<\/span> b2<span class=\"token operator\">*<\/span>b2 <span class=\"token operator\">&#8211;<\/span> <span class=\"token number\">4<\/span><span class=\"token operator\">*<\/span>a2<span class=\"token operator\">*<\/span>c2<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">double<\/span> tau <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span>a2 <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">?<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token operator\">&#8211;<\/span>b2 <span class=\"token operator\">&#043;<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">sqrt<\/span><span class=\"token punctuation\">(<\/span>disc<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token number\">2<\/span><span class=\"token operator\">*<\/span>a2<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">:<\/span> <span class=\"token number\">1.0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    tau <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">max<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">0.0<\/span><span class=\"token punctuation\">,<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">min<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">1.0<\/span><span class=\"token punctuation\">,<\/span> tau<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    Vec <span class=\"token function\">s<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> s<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> s_sd<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#043;<\/span> tau <span class=\"token operator\">*<\/span> d<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">return<\/span> s<span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ &#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061; lsqnonlin (TRR) &#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;<\/span><br \/>\n<span class=\"token keyword\">class<\/span> <span class=\"token class-name\">Lsqnonlin<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n<span class=\"token keyword\">public<\/span><span class=\"token operator\">:<\/span><br \/>\n    <span class=\"token keyword\">using<\/span> FunType <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span>function<span class=\"token operator\">&lt;<\/span><span class=\"token function\">Vec<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token operator\">&gt;<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">using<\/span> JacType <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span>function<span class=\"token operator\">&lt;<\/span><span class=\"token function\">Matrix<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token operator\">&gt;<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>    <span class=\"token keyword\">struct<\/span> <span class=\"token class-name\">Options<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        <span class=\"token keyword\">int<\/span>    maxIter       <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">400<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> stepTol       <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">1e-8<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> funcTol       <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">1e-12<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> optimalityTol <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">1e-8<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> Delta0        <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">1.0<\/span><span class=\"token punctuation\">;<\/span>      <span class=\"token comment\">\/\/ \u521d\u59cb\u4fe1\u8d56\u57df\u534a\u5f84<\/span><br \/>\n        <span class=\"token keyword\">bool<\/span>   verbose       <span class=\"token operator\">&#061;<\/span> <span class=\"token boolean\">false<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>    <span class=\"token keyword\">struct<\/span> <span class=\"token class-name\">Result<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        Vec    x<span class=\"token punctuation\">,<\/span> residual<span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> cost <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">int<\/span>    iterations <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">int<\/span>    exitFlag <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span>             <span class=\"token comment\">\/\/ 1:\u6700\u4f18\u6027\u6536\u655b 2:\u6b65\u957f\u6536\u655b 3:\u4fe1\u8d56\u57df\u8fc7\u5c0f 0:\u6700\u5927\u8fed\u4ee3<\/span><br \/>\n        <span class=\"token keyword\">bool<\/span> <span class=\"token function\">success<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">const<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token keyword\">return<\/span> exitFlag <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>    <span class=\"token keyword\">explicit<\/span> <span class=\"token function\">Lsqnonlin<\/span><span class=\"token punctuation\">(<\/span>FunType fun<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">:<\/span> <span class=\"token function\">fun_<\/span><span class=\"token punctuation\">(<\/span>std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">move<\/span><span class=\"token punctuation\">(<\/span>fun<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><span class=\"token punctuation\">}<\/span><br \/>\n    <span class=\"token function\">Lsqnonlin<\/span><span class=\"token punctuation\">(<\/span>FunType fun<span class=\"token punctuation\">,<\/span> JacType jac<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">:<\/span> <span class=\"token function\">fun_<\/span><span class=\"token punctuation\">(<\/span>std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">move<\/span><span class=\"token punctuation\">(<\/span>fun<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token function\">jac_<\/span><span class=\"token punctuation\">(<\/span>std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">move<\/span><span class=\"token punctuation\">(<\/span>jac<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><span class=\"token punctuation\">}<\/span><\/p>\n<p>    Result <span class=\"token function\">solve<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> x0<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token keyword\">return<\/span> <span class=\"token function\">solve<\/span><span class=\"token punctuation\">(<\/span>x0<span class=\"token punctuation\">,<\/span> <span class=\"token function\">Options<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><br \/>\n    Result <span class=\"token function\">solve<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> x0<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Options<span class=\"token operator\">&amp;<\/span> opts<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        <span class=\"token keyword\">const<\/span> <span class=\"token keyword\">int<\/span> n <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span><span class=\"token punctuation\">)<\/span>x0<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        Result res<span class=\"token punctuation\">;<\/span><br \/>\n        Vec x <span class=\"token operator\">&#061;<\/span> x0<span class=\"token punctuation\">;<\/span><\/p>\n<p>        Vec f <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">fun_<\/span><span class=\"token punctuation\">(<\/span>x<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> cost <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.5<\/span> <span class=\"token operator\">*<\/span> <span class=\"token function\">nrm2<\/span><span class=\"token punctuation\">(<\/span>f<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        Matrix J <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">computeJacobian<\/span><span class=\"token punctuation\">(<\/span>x<span class=\"token punctuation\">,<\/span> f<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>        <span class=\"token keyword\">double<\/span> Delta <span class=\"token operator\">&#061;<\/span> opts<span class=\"token punctuation\">.<\/span>Delta0<span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">const<\/span> <span class=\"token keyword\">double<\/span> eta <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.15<\/span><span class=\"token punctuation\">;<\/span>         <span class=\"token comment\">\/\/ \u6b65\u957f\u63a5\u53d7\u9608\u503c<\/span><\/p>\n<p>        <span class=\"token keyword\">int<\/span> iter <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span>iter <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> iter <span class=\"token operator\">&lt;<\/span> opts<span class=\"token punctuation\">.<\/span>maxIter<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>iter<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n            <span class=\"token comment\">\/\/ \u4e00\u9636\u6700\u4f18\u6027&#xff08;\u65e0\u7a77\u8303\u6570 \u2016J\u1d40f\u2016\u221e&#xff09;<\/span><br \/>\n            Vec <span class=\"token function\">g<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span><br \/>\n                <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span><span class=\"token punctuation\">)<\/span>f<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span><br \/>\n                    g<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#043;&#061;<\/span> <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>k<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>f<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">double<\/span> gInf <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">double<\/span> v <span class=\"token operator\">:<\/span> g<span class=\"token punctuation\">)<\/span> gInf <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">max<\/span><span class=\"token punctuation\">(<\/span>gInf<span class=\"token punctuation\">,<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">abs<\/span><span class=\"token punctuation\">(<\/span>v<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>            <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>gInf <span class=\"token operator\">&lt;<\/span> opts<span class=\"token punctuation\">.<\/span>optimalityTol<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> res<span class=\"token punctuation\">.<\/span>exitFlag <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><br \/>\n            <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>Delta    <span class=\"token operator\">&lt;<\/span> opts<span class=\"token punctuation\">.<\/span>stepTol<span class=\"token punctuation\">)<\/span>   <span class=\"token punctuation\">{<\/span> res<span class=\"token punctuation\">.<\/span>exitFlag <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><\/p>\n<p>            <span class=\"token comment\">\/\/ \u5b50\u95ee\u9898<\/span><br \/>\n            Vec s <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">solveTrustRegion<\/span><span class=\"token punctuation\">(<\/span>J<span class=\"token punctuation\">,<\/span> f<span class=\"token punctuation\">,<\/span> Delta<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>            <span class=\"token comment\">\/\/ \u9884\u6d4b\u4e0b\u964d<\/span><br \/>\n            Vec <span class=\"token function\">Jsf<\/span><span class=\"token punctuation\">(<\/span>f<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> k <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> k <span class=\"token operator\">&lt;<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span><span class=\"token punctuation\">)<\/span>f<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>k<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n                <span class=\"token keyword\">double<\/span> v <span class=\"token operator\">&#061;<\/span> f<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n                <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> v <span class=\"token operator\">&#043;&#061;<\/span> <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>k<span class=\"token punctuation\">,<\/span> i<span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>s<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n                Jsf<span class=\"token punctuation\">[<\/span>k<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> v<span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token punctuation\">}<\/span><br \/>\n            <span class=\"token keyword\">double<\/span> predRed <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.5<\/span> <span class=\"token operator\">*<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token function\">nrm2<\/span><span class=\"token punctuation\">(<\/span>f<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#8211;<\/span> <span class=\"token function\">nrm2<\/span><span class=\"token punctuation\">(<\/span>Jsf<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>            <span class=\"token comment\">\/\/ \u8bd5\u9a8c\u70b9<\/span><br \/>\n            Vec <span class=\"token function\">xNew<\/span><span class=\"token punctuation\">(<\/span>n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> xNew<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> x<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#043;<\/span> s<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            Vec fNew <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">fun_<\/span><span class=\"token punctuation\">(<\/span>xNew<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">double<\/span> costNew <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.5<\/span> <span class=\"token operator\">*<\/span> <span class=\"token function\">nrm2<\/span><span class=\"token punctuation\">(<\/span>fNew<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>            <span class=\"token keyword\">double<\/span> actRed <span class=\"token operator\">&#061;<\/span> cost <span class=\"token operator\">&#8211;<\/span> costNew<span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">double<\/span> rho <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span>predRed <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">?<\/span> actRed <span class=\"token operator\">\/<\/span> predRed <span class=\"token operator\">:<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1.0<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>            <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>opts<span class=\"token punctuation\">.<\/span>verbose<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n                std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  Iter %3d:  cost&#061;%.10e  rho&#061;%&#043;.4e  Delta&#061;%.4e  |g|&#061;%.4e\\\\n&#034;<\/span><span class=\"token punctuation\">,<\/span><br \/>\n                            iter<span class=\"token punctuation\">,<\/span> cost<span class=\"token punctuation\">,<\/span> rho<span class=\"token punctuation\">,<\/span> Delta<span class=\"token punctuation\">,<\/span> gInf<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token punctuation\">}<\/span><\/p>\n<p>            <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>rho <span class=\"token operator\">&gt;<\/span> eta<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n                <span class=\"token keyword\">double<\/span> stepNorm <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">norm<\/span><span class=\"token punctuation\">(<\/span>s<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n                <span class=\"token keyword\">double<\/span> costRel  <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">abs<\/span><span class=\"token punctuation\">(<\/span>cost <span class=\"token operator\">&#8211;<\/span> costNew<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">max<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">1.0<\/span><span class=\"token punctuation\">,<\/span> cost<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>                x <span class=\"token operator\">&#061;<\/span> xNew<span class=\"token punctuation\">;<\/span> f <span class=\"token operator\">&#061;<\/span> fNew<span class=\"token punctuation\">;<\/span> cost <span class=\"token operator\">&#061;<\/span> costNew<span class=\"token punctuation\">;<\/span><br \/>\n                J <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">computeJacobian<\/span><span class=\"token punctuation\">(<\/span>x<span class=\"token punctuation\">,<\/span> f<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>                <span class=\"token keyword\">if<\/span>      <span class=\"token punctuation\">(<\/span>rho <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">0.75<\/span><span class=\"token punctuation\">)<\/span> Delta <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">min<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">2.0<\/span><span class=\"token operator\">*<\/span>Delta<span class=\"token punctuation\">,<\/span> <span class=\"token number\">1e10<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n                <span class=\"token keyword\">else<\/span> <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>rho <span class=\"token operator\">&lt;<\/span> <span class=\"token number\">0.25<\/span><span class=\"token punctuation\">)<\/span> Delta <span class=\"token operator\">*&#061;<\/span> <span class=\"token number\">0.5<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>                <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>stepNorm <span class=\"token operator\">&lt;<\/span> opts<span class=\"token punctuation\">.<\/span>stepTol <span class=\"token operator\">*<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token function\">norm<\/span><span class=\"token punctuation\">(<\/span>x<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#043;<\/span> opts<span class=\"token punctuation\">.<\/span>stepTol<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n                    res<span class=\"token punctuation\">.<\/span>exitFlag <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">2<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span><br \/>\n                <span class=\"token punctuation\">}<\/span><br \/>\n                <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>costRel <span class=\"token operator\">&lt;<\/span> opts<span class=\"token punctuation\">.<\/span>funcTol<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> res<span class=\"token punctuation\">.<\/span>exitFlag <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><br \/>\n            <span class=\"token punctuation\">}<\/span> <span class=\"token keyword\">else<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n                Delta <span class=\"token operator\">*&#061;<\/span> <span class=\"token number\">0.5<\/span><span class=\"token punctuation\">;<\/span><br \/>\n                <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>Delta <span class=\"token operator\">&lt;<\/span> opts<span class=\"token punctuation\">.<\/span>stepTol<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> res<span class=\"token punctuation\">.<\/span>exitFlag <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token punctuation\">}<\/span><br \/>\n            <span class=\"token punctuation\">}<\/span><br \/>\n        <span class=\"token punctuation\">}<\/span><\/p>\n<p>        res<span class=\"token punctuation\">.<\/span>x <span class=\"token operator\">&#061;<\/span> x<span class=\"token punctuation\">;<\/span> res<span class=\"token punctuation\">.<\/span>residual <span class=\"token operator\">&#061;<\/span> f<span class=\"token punctuation\">;<\/span> res<span class=\"token punctuation\">.<\/span>cost <span class=\"token operator\">&#061;<\/span> cost<span class=\"token punctuation\">;<\/span> res<span class=\"token punctuation\">.<\/span>iterations <span class=\"token operator\">&#061;<\/span> iter<span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">return<\/span> res<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token keyword\">private<\/span><span class=\"token operator\">:<\/span><br \/>\n    Matrix <span class=\"token function\">computeJacobian<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> x<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> f<span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">const<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        <span class=\"token keyword\">return<\/span> jac_ <span class=\"token operator\">?<\/span> <span class=\"token function\">jac_<\/span><span class=\"token punctuation\">(<\/span>x<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">:<\/span> <span class=\"token function\">numericalJacobian<\/span><span class=\"token punctuation\">(<\/span>x<span class=\"token punctuation\">,<\/span> f<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><br \/>\n    Matrix <span class=\"token function\">numericalJacobian<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> x<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> f0<span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">const<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n        <span class=\"token keyword\">int<\/span> n <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span><span class=\"token punctuation\">)<\/span>x<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> m <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span><span class=\"token punctuation\">)<\/span>f0<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        Matrix <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>m<span class=\"token punctuation\">,<\/span> n<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">double<\/span> sqEps <span class=\"token operator\">&#061;<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">sqrt<\/span><span class=\"token punctuation\">(<\/span>std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token class-name\">numeric_limits<\/span><span class=\"token operator\">&lt;<\/span><span class=\"token keyword\">double<\/span><span class=\"token operator\">&gt;<\/span><span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">epsilon<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> j <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> j <span class=\"token operator\">&lt;<\/span> n<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>j<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n            <span class=\"token keyword\">double<\/span> h <span class=\"token operator\">&#061;<\/span> sqEps <span class=\"token operator\">*<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">max<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">1.0<\/span><span class=\"token punctuation\">,<\/span> std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">abs<\/span><span class=\"token punctuation\">(<\/span>x<span class=\"token punctuation\">[<\/span>j<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            Vec xp <span class=\"token operator\">&#061;<\/span> x<span class=\"token punctuation\">;<\/span> xp<span class=\"token punctuation\">[<\/span>j<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#043;&#061;<\/span> h<span class=\"token punctuation\">;<\/span><br \/>\n            Vec fp <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">fun_<\/span><span class=\"token punctuation\">(<\/span>xp<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span> i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> m<span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span> <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span>i<span class=\"token punctuation\">,<\/span> j<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span>fp<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#8211;<\/span> f0<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> h<span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token punctuation\">}<\/span><br \/>\n        <span class=\"token keyword\">return<\/span> J<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><br \/>\n    FunType fun_<span class=\"token punctuation\">;<\/span><br \/>\n    JacType jac_<span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p><span class=\"token comment\">\/\/ &#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061; \u6d4b\u8bd5\u4e3b\u7a0b\u5e8f &#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;<\/span><br \/>\n<span class=\"token keyword\">static<\/span> <span class=\"token keyword\">void<\/span> <span class=\"token function\">printVec<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> <span class=\"token keyword\">char<\/span><span class=\"token operator\">*<\/span> name<span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> v<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;%s &#061; [&#034;<\/span><span class=\"token punctuation\">,<\/span> name<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span>size_t i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> v<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;%s%.12g&#034;<\/span><span class=\"token punctuation\">,<\/span> i <span class=\"token operator\">?<\/span> <span class=\"token string\">&#034;, &#034;<\/span> <span class=\"token operator\">:<\/span> <span class=\"token string\">&#034;&#034;<\/span><span class=\"token punctuation\">,<\/span> v<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;]\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token keyword\">int<\/span> <span class=\"token function\">main<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034; MATLAB lsqnonlin \u9ed8\u8ba4\u7b97\u6cd5: trust-region-reflective\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;&#061;\\\\n\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>    <span class=\"token comment\">\/\/ &#8212;&#8212;&#8212;- \u7528\u4f8b 1: Rosenbrock \u6700\u5c0f\u4e8c\u4e58 &#8212;&#8212;&#8212;-<\/span><br \/>\n    <span class=\"token punctuation\">{<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;&#8212;&#8212;&#8212;- \u7528\u4f8b 1: Rosenbrock \u6700\u5c0f\u4e8c\u4e58 &#8212;&#8212;&#8212;-\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  r1 &#061; 10*(x2 &#8211; x1^2)\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  r2 &#061; 1 &#8211; x1\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  x0 &#061; [-1.2, 1.0]&#xff0c;\u671f\u671b\u6700\u4f18 x* &#061; [1, 1]\\\\n\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>        <span class=\"token keyword\">auto<\/span> fun <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> x<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">-&gt;<\/span> Vec <span class=\"token punctuation\">{<\/span><br \/>\n            <span class=\"token keyword\">return<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token number\">10.0<\/span><span class=\"token operator\">*<\/span><span class=\"token punctuation\">(<\/span>x<span class=\"token punctuation\">[<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#8211;<\/span> x<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span><span class=\"token operator\">*<\/span>x<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1.0<\/span> <span class=\"token operator\">&#8211;<\/span> x<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">auto<\/span> jac <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> x<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">-&gt;<\/span> Matrix <span class=\"token punctuation\">{<\/span><br \/>\n            Matrix <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">2<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">20.0<\/span><span class=\"token operator\">*<\/span>x<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span>  <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">10.0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1.0<\/span><span class=\"token punctuation\">;<\/span>        <span class=\"token function\">J<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">return<\/span> J<span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>        Lsqnonlin<span class=\"token double-colon punctuation\">::<\/span>Options opts<span class=\"token punctuation\">;<\/span><br \/>\n        opts<span class=\"token punctuation\">.<\/span>verbose <span class=\"token operator\">&#061;<\/span> <span class=\"token boolean\">true<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>        Lsqnonlin <span class=\"token function\">solver<\/span><span class=\"token punctuation\">(<\/span>fun<span class=\"token punctuation\">,<\/span> jac<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        Vec x0 <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1.2<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1.0<\/span> <span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">auto<\/span> res <span class=\"token operator\">&#061;<\/span> solver<span class=\"token punctuation\">.<\/span><span class=\"token function\">solve<\/span><span class=\"token punctuation\">(<\/span>x0<span class=\"token punctuation\">,<\/span> opts<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;\\\\n  &#8212;&#8212;&#8212;- \u6c42\u89e3\u7ed3\u675f &#8212;&#8212;&#8212;-\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token function\">printVec<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  x&#034;<\/span><span class=\"token punctuation\">,<\/span> res<span class=\"token punctuation\">.<\/span>x<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token function\">printVec<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  residual&#034;<\/span><span class=\"token punctuation\">,<\/span> res<span class=\"token punctuation\">.<\/span>residual<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  cost       &#061; %.6e\\\\n&#034;<\/span><span class=\"token punctuation\">,<\/span>  res<span class=\"token punctuation\">.<\/span>cost<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  iterations &#061; %d\\\\n&#034;<\/span><span class=\"token punctuation\">,<\/span>     res<span class=\"token punctuation\">.<\/span>iterations<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  exitFlag   &#061; %d\\\\n\\\\n&#034;<\/span><span class=\"token punctuation\">,<\/span>   res<span class=\"token punctuation\">.<\/span>exitFlag<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><\/p>\n<p>    <span class=\"token comment\">\/\/ &#8212;&#8212;&#8212;- \u7528\u4f8b 2: \u6307\u6570\u62df\u5408&#xff08;\u6570\u503c\u96c5\u53ef\u6bd4&#xff09;&#8212;&#8212;&#8212;-<\/span><br \/>\n    <span class=\"token punctuation\">{<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;&#8212;&#8212;&#8212;- \u7528\u4f8b 2: \u6307\u6570\u62df\u5408 y &#061; a*exp(b*t) &#8212;&#8212;&#8212;-\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">const<\/span> std<span class=\"token double-colon punctuation\">::<\/span>vector<span class=\"token operator\">&lt;<\/span><span class=\"token keyword\">double<\/span><span class=\"token operator\">&gt;<\/span> t <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">{<\/span><span class=\"token number\">0.0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1.0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1.5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">2.0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">2.5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">3.0<\/span><span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">const<\/span> std<span class=\"token double-colon punctuation\">::<\/span>vector<span class=\"token operator\">&lt;<\/span><span class=\"token keyword\">double<\/span><span class=\"token operator\">&gt;<\/span> y <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">{<\/span><span class=\"token number\">2.60<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1.80<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1.30<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.91<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.63<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.44<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.31<\/span><span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  \u771f\u503c a\u22482.5, b\u2248-0.7&#xff0c;\u521d\u503c p0 &#061; [1.0, 0.0]\\\\n\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>        <span class=\"token keyword\">auto<\/span> fun <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">[<\/span><span class=\"token operator\">&amp;<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">const<\/span> Vec<span class=\"token operator\">&amp;<\/span> p<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">-&gt;<\/span> Vec <span class=\"token punctuation\">{<\/span><br \/>\n            Vec <span class=\"token function\">r<\/span><span class=\"token punctuation\">(<\/span>t<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> <span class=\"token punctuation\">(<\/span>size_t i <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> i <span class=\"token operator\">&lt;<\/span> t<span class=\"token punctuation\">.<\/span><span class=\"token function\">size<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token operator\">&#043;&#043;<\/span>i<span class=\"token punctuation\">)<\/span><br \/>\n                r<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> p<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span><span class=\"token operator\">*<\/span>std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">exp<\/span><span class=\"token punctuation\">(<\/span>p<span class=\"token punctuation\">[<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">]<\/span><span class=\"token operator\">*<\/span>t<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#8211;<\/span> y<span class=\"token punctuation\">[<\/span>i<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n            <span class=\"token keyword\">return<\/span> r<span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>        Lsqnonlin<span class=\"token double-colon punctuation\">::<\/span>Options opts<span class=\"token punctuation\">;<\/span><br \/>\n        opts<span class=\"token punctuation\">.<\/span>verbose <span class=\"token operator\">&#061;<\/span> <span class=\"token boolean\">true<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        Lsqnonlin <span class=\"token function\">solver<\/span><span class=\"token punctuation\">(<\/span>fun<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span>   <span class=\"token comment\">\/\/ \u4f7f\u7528\u6570\u503c\u96c5\u53ef\u6bd4<\/span><br \/>\n        Vec p0 <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token number\">1.0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.0<\/span> <span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token keyword\">auto<\/span> res <span class=\"token operator\">&#061;<\/span> solver<span class=\"token punctuation\">.<\/span><span class=\"token function\">solve<\/span><span class=\"token punctuation\">(<\/span>p0<span class=\"token punctuation\">,<\/span> opts<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;\\\\n  &#8212;&#8212;&#8212;- \u6c42\u89e3\u7ed3\u675f &#8212;&#8212;&#8212;-\\\\n&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        <span class=\"token function\">printVec<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  p (a, b)&#034;<\/span><span class=\"token punctuation\">,<\/span> res<span class=\"token punctuation\">.<\/span>x<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  cost       &#061; %.6e\\\\n&#034;<\/span><span class=\"token punctuation\">,<\/span>  res<span class=\"token punctuation\">.<\/span>cost<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  iterations &#061; %d\\\\n&#034;<\/span><span class=\"token punctuation\">,<\/span>     res<span class=\"token punctuation\">.<\/span>iterations<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n        std<span class=\"token double-colon punctuation\">::<\/span><span class=\"token function\">printf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;  exitFlag   &#061; %d\\\\n\\\\n&#034;<\/span><span class=\"token punctuation\">,<\/span>   res<span class=\"token punctuation\">.<\/span>exitFlag<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><br \/>\n    <span class=\"token keyword\">return<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n","protected":false},"excerpt":{"rendered":"<p>\/\/<br \/>\n\/\/  lsqnonlin.cpp<br \/>\n\/\/  MATLAB \u9ed8\u8ba4\u7b97\u6cd5 trust-region-reflective \u7684\u72ec\u7acb\u5b9e\u73b0<br \/>\n\/\/  \u7f16\u8bd1: g -O2 -stdc17 lsqnonlin_trr.cpp -o lsqtrr<br \/>\n\/\/<br \/>\n#include<br \/>\n#include<br \/>\n#include<br \/>\n#include<br \/>\n#include<br \/>\n#include using<\/p>\n","protected":false},"author":2,"featured_media":0,"comment_status":"open","ping_status":"open","sticky":false,"template":"","format":"standard","meta":{"footnotes":""},"categories":[1],"tags":[55,1284,190,427],"topic":[],"class_list":["post-110129","post","type-post","status-publish","format-standard","hentry","category-server","tag-c","tag-matlab","tag-190","tag-427"],"yoast_head":"<!-- This site is optimized with the Yoast SEO plugin v20.3 - https:\/\/yoast.com\/wordpress\/plugins\/seo\/ -->\n<title>C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3<\/title>\n<meta name=\"robots\" content=\"index, follow, max-snippet:-1, max-image-preview:large, max-video-preview:-1\" \/>\n<link rel=\"canonical\" href=\"https:\/\/www.wsisp.com\/helps\/110129.html\" \/>\n<meta property=\"og:locale\" content=\"zh_CN\" \/>\n<meta property=\"og:type\" content=\"article\" \/>\n<meta property=\"og:title\" content=\"C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\" \/>\n<meta property=\"og:description\" content=\"\/\/ \/\/ lsqnonlin.cpp \/\/ MATLAB \u9ed8\u8ba4\u7b97\u6cd5 trust-region-reflective \u7684\u72ec\u7acb\u5b9e\u73b0 \/\/ \u7f16\u8bd1: g -O2 -stdc17 lsqnonlin_trr.cpp -o lsqtrr \/\/ #include #include #include #include #include #include using\" \/>\n<meta property=\"og:url\" content=\"https:\/\/www.wsisp.com\/helps\/110129.html\" \/>\n<meta property=\"og:site_name\" content=\"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\" \/>\n<meta property=\"article:published_time\" content=\"2026-09-25T22:49:04+00:00\" \/>\n<meta name=\"author\" content=\"admin\" \/>\n<meta name=\"twitter:card\" content=\"summary_large_image\" \/>\n<meta name=\"twitter:label1\" content=\"\u4f5c\u8005\" \/>\n\t<meta name=\"twitter:data1\" content=\"admin\" \/>\n\t<meta name=\"twitter:label2\" content=\"\u9884\u8ba1\u9605\u8bfb\u65f6\u95f4\" \/>\n\t<meta name=\"twitter:data2\" content=\"8 \u5206\" \/>\n<script type=\"application\/ld+json\" class=\"yoast-schema-graph\">{\"@context\":\"https:\/\/schema.org\",\"@graph\":[{\"@type\":\"WebPage\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/110129.html\",\"url\":\"https:\/\/www.wsisp.com\/helps\/110129.html\",\"name\":\"C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\",\"isPartOf\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/#website\"},\"datePublished\":\"2026-09-25T22:49:04+00:00\",\"dateModified\":\"2026-09-25T22:49:04+00:00\",\"author\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41\"},\"breadcrumb\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/110129.html#breadcrumb\"},\"inLanguage\":\"zh-Hans\",\"potentialAction\":[{\"@type\":\"ReadAction\",\"target\":[\"https:\/\/www.wsisp.com\/helps\/110129.html\"]}]},{\"@type\":\"BreadcrumbList\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/110129.html#breadcrumb\",\"itemListElement\":[{\"@type\":\"ListItem\",\"position\":1,\"name\":\"\u9996\u9875\",\"item\":\"https:\/\/www.wsisp.com\/helps\"},{\"@type\":\"ListItem\",\"position\":2,\"name\":\"C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd\"}]},{\"@type\":\"WebSite\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#website\",\"url\":\"https:\/\/www.wsisp.com\/helps\/\",\"name\":\"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\",\"description\":\"\u9999\u6e2f\u670d\u52a1\u5668_\u9999\u6e2f\u4e91\u670d\u52a1\u5668\u8d44\u8baf_\u670d\u52a1\u5668\u5e2e\u52a9\u6587\u6863_\u670d\u52a1\u5668\u6559\u7a0b\",\"potentialAction\":[{\"@type\":\"SearchAction\",\"target\":{\"@type\":\"EntryPoint\",\"urlTemplate\":\"https:\/\/www.wsisp.com\/helps\/?s={search_term_string}\"},\"query-input\":\"required name=search_term_string\"}],\"inLanguage\":\"zh-Hans\"},{\"@type\":\"Person\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41\",\"name\":\"admin\",\"image\":{\"@type\":\"ImageObject\",\"inLanguage\":\"zh-Hans\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/image\/\",\"url\":\"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery\",\"contentUrl\":\"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery\",\"caption\":\"admin\"},\"sameAs\":[\"http:\/\/wp.wsisp.com\"],\"url\":\"https:\/\/www.wsisp.com\/helps\/author\/admin\"}]}<\/script>\n<!-- \/ Yoast SEO plugin. -->","yoast_head_json":{"title":"C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","robots":{"index":"index","follow":"follow","max-snippet":"max-snippet:-1","max-image-preview":"max-image-preview:large","max-video-preview":"max-video-preview:-1"},"canonical":"https:\/\/www.wsisp.com\/helps\/110129.html","og_locale":"zh_CN","og_type":"article","og_title":"C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","og_description":"\/\/ \/\/ lsqnonlin.cpp \/\/ MATLAB \u9ed8\u8ba4\u7b97\u6cd5 trust-region-reflective \u7684\u72ec\u7acb\u5b9e\u73b0 \/\/ \u7f16\u8bd1: g -O2 -stdc17 lsqnonlin_trr.cpp -o lsqtrr \/\/ #include #include #include #include #include #include using","og_url":"https:\/\/www.wsisp.com\/helps\/110129.html","og_site_name":"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","article_published_time":"2026-09-25T22:49:04+00:00","author":"admin","twitter_card":"summary_large_image","twitter_misc":{"\u4f5c\u8005":"admin","\u9884\u8ba1\u9605\u8bfb\u65f6\u95f4":"8 \u5206"},"schema":{"@context":"https:\/\/schema.org","@graph":[{"@type":"WebPage","@id":"https:\/\/www.wsisp.com\/helps\/110129.html","url":"https:\/\/www.wsisp.com\/helps\/110129.html","name":"C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","isPartOf":{"@id":"https:\/\/www.wsisp.com\/helps\/#website"},"datePublished":"2026-09-25T22:49:04+00:00","dateModified":"2026-09-25T22:49:04+00:00","author":{"@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41"},"breadcrumb":{"@id":"https:\/\/www.wsisp.com\/helps\/110129.html#breadcrumb"},"inLanguage":"zh-Hans","potentialAction":[{"@type":"ReadAction","target":["https:\/\/www.wsisp.com\/helps\/110129.html"]}]},{"@type":"BreadcrumbList","@id":"https:\/\/www.wsisp.com\/helps\/110129.html#breadcrumb","itemListElement":[{"@type":"ListItem","position":1,"name":"\u9996\u9875","item":"https:\/\/www.wsisp.com\/helps"},{"@type":"ListItem","position":2,"name":"C++\u4ee3\u7801\u5b9e\u73b0MATLAB\u4e2d\u7684lsqnonlin\u51fd\u6570\u529f\u80fd"}]},{"@type":"WebSite","@id":"https:\/\/www.wsisp.com\/helps\/#website","url":"https:\/\/www.wsisp.com\/helps\/","name":"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","description":"\u9999\u6e2f\u670d\u52a1\u5668_\u9999\u6e2f\u4e91\u670d\u52a1\u5668\u8d44\u8baf_\u670d\u52a1\u5668\u5e2e\u52a9\u6587\u6863_\u670d\u52a1\u5668\u6559\u7a0b","potentialAction":[{"@type":"SearchAction","target":{"@type":"EntryPoint","urlTemplate":"https:\/\/www.wsisp.com\/helps\/?s={search_term_string}"},"query-input":"required name=search_term_string"}],"inLanguage":"zh-Hans"},{"@type":"Person","@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41","name":"admin","image":{"@type":"ImageObject","inLanguage":"zh-Hans","@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/image\/","url":"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery","contentUrl":"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery","caption":"admin"},"sameAs":["http:\/\/wp.wsisp.com"],"url":"https:\/\/www.wsisp.com\/helps\/author\/admin"}]}},"_links":{"self":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts\/110129","targetHints":{"allow":["GET"]}}],"collection":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts"}],"about":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/types\/post"}],"author":[{"embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/users\/2"}],"replies":[{"embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/comments?post=110129"}],"version-history":[{"count":0,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts\/110129\/revisions"}],"wp:attachment":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/media?parent=110129"}],"wp:term":[{"taxonomy":"category","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/categories?post=110129"},{"taxonomy":"post_tag","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/tags?post=110129"},{"taxonomy":"topic","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/topic?post=110129"}],"curies":[{"name":"wp","href":"https:\/\/api.w.org\/{rel}","templated":true}]}}