Revision 1134
Added a heavily modified version of map.m called sensor_map, which first constructs a sensor model, then maps data according to the sensor model.
NEEDS to be converted to log-odds to speed up computation. There is still a transformation that needs to take place per datapoint per sensor, but
theres not much I think I can do about that.
prob_map.m | ||
---|---|---|
35 | 35 |
|
36 | 36 |
points = []; |
37 | 37 |
|
38 |
%Map area: |
|
39 |
[X1,X2] = meshgrid(-100:5:100,-100:5:100);
|
|
40 |
X = [X1(:),X2(:)];
|
|
41 |
prob_map = zeros(size(X1,1),size(X2,2));
|
|
38 |
%Map area, defined in centimeters:
|
|
39 |
[X,Y] = meshgrid(-100:2:100,-100:2:100);
|
|
40 |
%V = [X1(:),X2(:)];
|
|
41 |
prob_map = zeros(size(X,1),size(Y,2));
|
|
42 | 42 |
|
43 |
|
|
43 | 44 |
%Set position and range error constant for testing FIXME! |
44 | 45 |
range_error = 250; |
45 | 46 |
pos_error = 500; |
Also available in: Unified diff