2、室内定位-基于RSSI测距的三维算法

1、加一个参数

>> a_x=[0 0 7 7];>> b_y=[0 7 7 0];>> c_z=[7 7 7 7]>>>  d=[10; 11; 12; 13]>> Q=[-2*a_x(1) -2*b_y(1) -2*c_z(1) 1;      -2*a_x(2) -2*b_y(2) -2*c_z(2) 1;      -2*a_x(3) -2*b_y(3) -2*c_z(3) 1;      -2*a_x(4) -2*b_y(4) -2*c_z(4) 1]>> temp =[a_x(1)^2 + b_y(1)^2 + c_z(1)^2; a_x(2)^2 + b_y(2)^2 + c_z(2)^2; a_x(3)^2 + b_y(3)^2 + c_z(3)^2; a_x(4)^2 + b_y(4)^2 + c_z(4)^2]>>b = d - tempget_xyzR2=(inv(Q'*Q))*Q'*b

2、最小二乘

 beacon_x=[0 0 7 7]; beacon_y=[0 7 7 0]; beacon_z=[7 7 7 7]; Q=2*[beacon_x(4)- beacon_x(1) beacon_y(4)- beacon_y(1) beacon_z(4)- beacon_z(1);beacon_x(4)- beacon_x(2) beacon_y(4)- beacon_y(2) beacon_z(4)- beacon_z(2);beacon_x(4)- beacon_x(3) beacon_y(4)- beacon_y(3) beacon_z(4)- beacon_z(3)] bieacon_d=[8;10;11;12]; >>  b=[bieacon_d(1)^2-bieacon_d(4)^2; bieacon_d(2)^2-bieacon_d(4)^2; bieacon_d(3)^2-bieacon_d(4)^2]//inv(Q'*Q)可能不存在>> get_xyz=(inv(Q'*Q))*Q'*b