diff options
author | YanzhenXiangRobotics <xyz000327@gmail.com> | 2023-05-10 23:13:51 +0200 |
---|---|---|
committer | YanzhenXiangRobotics <xyz000327@gmail.com> | 2023-05-10 23:13:51 +0200 |
commit | c5cdd03fc0588f7d34d8b97713caa6d19e5becea (patch) | |
tree | 37b4d81c124a07b23e2d626ad9501ed70b301d33 /templates/chebycenter.m | |
parent | Update progress.md (diff) | |
download | mpc_pe-c5cdd03fc0588f7d34d8b97713caa6d19e5becea.tar.gz mpc_pe-c5cdd03fc0588f7d34d8b97713caa6d19e5becea.zip |
ADD: pass task 25
Diffstat (limited to '')
-rwxr-xr-x | templates/chebycenter.m | 20 |
1 files changed, 20 insertions, 0 deletions
diff --git a/templates/chebycenter.m b/templates/chebycenter.m new file mode 100755 index 0000000..cbdce1c --- /dev/null +++ b/templates/chebycenter.m @@ -0,0 +1,20 @@ +function [c,r] = chebycenter(A,b) +%CHEBYCENTER Compute Chebyshev center of polytope Ax <= b. +% The Chebyshev center of a polytope is the center of the largest +% hypersphere enclosed by the polytope. +% Requires optimization toolbox. + +[n,p] = size(A); +an = sqrt(sum(A.^2,2)); +A1 = zeros(n,p+1); +A1(:,1:p) = A; +A1(:,p+1) = an; +f = zeros(p+1,1); +f(p+1) = -1; + +options = optimset; +options = optimset(options,'Display', 'off'); +c = linprog(f,A1,b,[],[],[],[],[],options); +r = c(p+1); +c = c(1:p); +end |