dingweiwucha.m

关于室内定位的算法

true=[1.0 1.0;
      1.0,2.0;
      1.0,3.0;
1.0,4.0;
1.0,5.0;
1.0,6.0;
1.0,7.0;
2.0,1.0;
2.0,2.0;
2.0,3.0;
2.0,4.0;
2.0,5.0;
2.0,6.0;
2.0,7.0;
3.0,1.0;
3.0,2.0;
3.0,3.0;
3.0,4.0;
3.0,5.0;
3.0,6.0;
3.0,7.0;
4.0,1.0;
4.0,2.0;
4.0,3.0;
4.0,4.0;
4.0,5.0;
4.0,6.0;
4.0,7.0;
5.0,1.0;
5.0,2.0;
5.0,3.0;
5.0,4.0;
5.0,5.0;
5.0,6.0;
5.0,7.0;
6.0,1.0;
6.0,2.0;
6.0,3.0;
6.0,4.0;
6.0,5.0;
6.0,6.0;
6.0,7.0;
7.0,1.0;
7.0,2.0;
7.0,3.0;
7.0,4.0;
7.0,5.0;
7.0,6.0;
7.0,7.0
]
measure=[0.75,1.5;
1.25,2.5;
0.75,3.0;
1.25,3.75;
1.0,4.75;
1.5,6.25;
1.75,6.25;
1.75,1.25;
2.75,2.75;
1.75,3.25;
2.25,4.25;
1.75,6.0;
1.75,5.75;
1.5,6.75;
2.75,0.75;
2.5,2.25;
3.25,3.75;
3.0,4.25;
2.75,5.25;
3.0,5.75;
3.5,5.75;
3.5,2.0;
3.0,3.0;
3.0,3.75;
3.5,3.5;
4.5,4.5;
2.5,6.0;
3.25,6.25;
3.5,0.5;
5.5,2.75;
4.25,4.0;
4.5,4.0;
4.5,4.25;
4.0,4.0;
4.25,5.75;
5.25,1.5;
4.75,2.5;
5.5,2.75;
5.5,4.0;
5.75,4.25;
5.25,5.0;
5.25,6.5;
6.5,1.25;
6.0,2.5;
6.5,3.5;
5.75,2.75;
7.0,3.25;
6.25,5.25;
6.5,6.25
]
plot(true(:,1),true(:,2),'r*')
xlabel('X(m)')
ylabel('Y(m)')
hold on
plot(measure(:,1),measure(:,2),'g+')
grid
axis([0,8,0,8])
text(1,1,'1')
text(1,2,'2')
text(1,3,'3')
text(1,4,'4')
text(1,5,'5')
text(1,6,'6')
text(1,7,'7')
text(2,1,'8')
text(2,2,'9')
text(2,3,'10')
text(2,4,'11')
text(2,5,'12')
text(2,6,'13')
text(2,7,'14')
text(3,1,'15')
text(3,2,'16')
text(3,3,'17')
text(3,4,'18')
text(3,5,'19')
text(3,6,'20')
text(3,7,'21')
text(4,1,'22')
text(4,2,'23')
text(4,3,'24')
text(4,4,'25')
text(4,5,'26')
text(4,6,'27')
text(4,7,'28')
text(5,1,'29')
text(5,2,'30')
text(5,3,'31')
text(5,4,'32')
text(5,5,'33')
text(5,6,'34')
text(5,7,'35')
text(6,1,'36')
text(6,2,'37')
text(6,3,'38')
text(6,4,'39')
text(6,5,'40')
text(6,6,'41')
text(6,7,'42')
text(7,1,'43')
text(7,2,'44')
text(7,3,'45')
text(7,4,'46')
text(7,5,'47')
text(7,6,'48')
text(7,7,'49')


 text(0.75,1.0,'1')
 text(1.25,2.5,'2')
text(0.75,4.0,'3')
text(1.25,3.75,'4')
text(1.0,4.75,'5')
text(1.5,6.25,'6')
text(1.75,6.25,'7')
text(1.75,1.25,'8')
text(2.75,2.75,'9')
text(1.75,3.25,'10')
text(2.25,4.25,'11')
text(1.75,6.0,'12')
text(1.75,5.75,'13')
text(1.5,6.75,'14')
text(2.75,0.75,'15')
text(2.5,2.25,'16')
text(3.25,3.75,'17')
text(3.0,4.25,'18')
text(2.5,5.25,'19')
text(3.0,5.75,'20')
 text(3.5,5.75,'21')
text(3.5,2.0,'22')
 text(3.0,3.0,'23')
text(3.0,3.75,'24')
text(3.75,3.75,'25')
text(4.5,4.5,'26')
text(2.5,6.0,'27')
 text(3.25,6.25,'28')
text(3.5,0.5,'29')
text(5.5,2.55,'30')
text(4.25,4.0,'31')
text(4.5,4.0,'32')
 text(4.5,4.25,'33')
text(4.20,4.20,'34')
text(4.25,5.75,'35')
text(5.25,1.5,'36')
text(4.75,2.5,'37')
text(5.5,2.75,'38')
text(5.5,4.0,'39')
text(5.75,4.25,'40')
text(5.25,5.0,'41')
text(5.25,6.5,'42')
text(6.5,1.25,'43')
text(6.0,2.5,'44')
text(6.5,3.5,'45')
text(5.75,2.75,'46')
text(7.0,3.25,'47')
text(6.25,5.25,'48')
text(6.5,6.5,'49')