| | 1 | | using PointCloud.Benchmark.Common; |
| | 2 | |
|
| | 3 | | namespace PointCloud.Benchmark.Filter; |
| | 4 | |
|
| | 5 | | /// <summary> |
| | 6 | | /// A two-dimensional box-blur with separated kernels |
| | 7 | | /// </summary> |
| | 8 | | public class BoxFilter |
| | 9 | | { |
| | 10 | | #region fields |
| | 11 | |
|
| | 12 | | private int _radius, _diameter, _width; |
| | 13 | |
|
| | 14 | | #endregion |
| | 15 | |
|
| | 16 | | #region properties |
| | 17 | |
|
| | 18 | | /// <summary> |
| | 19 | | /// Gets or sets the radius. |
| | 20 | | /// </summary> |
| | 21 | | /// <value> |
| | 22 | | /// The radius. |
| | 23 | | /// </value> |
| | 24 | | public int Radius |
| | 25 | | { |
| 0 | 26 | | get => _radius; |
| 0 | 27 | | set => SetRadius(value); |
| | 28 | | } |
| | 29 | |
|
| 0 | 30 | | public float DefaultValue { get; set; } |
| | 31 | |
|
| | 32 | | #endregion |
| | 33 | |
|
| | 34 | | #region constructor |
| | 35 | |
|
| | 36 | | /// <summary> |
| | 37 | | /// Initializes a new instance of the <see cref="BoxFilter"/> class. |
| | 38 | | /// </summary> |
| | 39 | | /// <param name="radius">The radius.</param> |
| 0 | 40 | | public BoxFilter(int radius) => SetRadius(radius); |
| | 41 | |
|
| | 42 | | #endregion |
| | 43 | |
|
| | 44 | | #region methods |
| | 45 | |
|
| | 46 | | /// <summary> |
| | 47 | | /// Filters highly frequented changes in a field of <see cref="ReFlex.Core.Common.Components.Point3"/>. |
| | 48 | | /// </summary> |
| | 49 | | public void Filter(PointCloud3 target) |
| 0 | 50 | | { |
| 0 | 51 | | var targetRef = target.AsJaggedArray(); |
| 0 | 52 | | var width = target.SizeX; |
| 0 | 53 | | var height = target.SizeY; |
| | 54 | |
|
| | 55 | | // x direction |
| 0 | 56 | | for (var y = 0; y < height; ++y) |
| 0 | 57 | | { |
| 0 | 58 | | var start = targetRef[0][y]; |
| 0 | 59 | | var sum = DefaultValue * _diameter; |
| | 60 | |
|
| 0 | 61 | | for (var x = 0; x < width; x++) |
| 0 | 62 | | { |
| 0 | 63 | | var nrad = x - _radius - 1; |
| 0 | 64 | | var prad = x + _radius; |
| | 65 | |
|
| 0 | 66 | | var sub = nrad >= 0 ? targetRef[nrad][y] : start; |
| 0 | 67 | | var add = prad < width ? targetRef[prad][y] : targetRef[width - 1][y]; |
| | 68 | |
|
| 0 | 69 | | sum -= sub.IsValid ? sub.Z : DefaultValue; |
| 0 | 70 | | sum += add.IsValid ? add.Z : DefaultValue; |
| | 71 | |
|
| 0 | 72 | | targetRef[x][y].Z = sum / _diameter; |
| 0 | 73 | | } |
| 0 | 74 | | } |
| | 75 | |
|
| | 76 | | // y direction |
| 0 | 77 | | for (var x = 0; x < width; ++x) |
| 0 | 78 | | { |
| 0 | 79 | | var start = targetRef[x][0]; |
| 0 | 80 | | var sum = DefaultValue * _diameter; |
| | 81 | |
|
| 0 | 82 | | for (var y = 0; y < height; y++) |
| 0 | 83 | | { |
| 0 | 84 | | var nrad = y - _radius - 1; |
| 0 | 85 | | var prad = y + _radius; |
| | 86 | |
|
| 0 | 87 | | var sub = nrad >= 0 ? targetRef[x][nrad] : start; |
| 0 | 88 | | var add = prad < height ? targetRef[x][prad] : targetRef[x][height - 1]; |
| | 89 | |
|
| 0 | 90 | | sum -= sub.IsValid ? sub.Z : DefaultValue; |
| 0 | 91 | | sum += add.IsValid ? add.Z : DefaultValue; |
| | 92 | |
|
| 0 | 93 | | targetRef[x][y].Z = sum / _diameter; |
| 0 | 94 | | } |
| 0 | 95 | | } |
| 0 | 96 | | } |
| | 97 | |
|
| | 98 | | /// <summary> |
| | 99 | | /// Filters highly frequented changes in a field of <see cref="ReFlex.Core.Common.Components.Point3"/>. |
| | 100 | | /// </summary> |
| | 101 | | public void FilterOptimized(PointCloud3 target) |
| 0 | 102 | | { |
| 0 | 103 | | var targetRef = target.AsSpan(); |
| 0 | 104 | | _width = target.SizeX; |
| 0 | 105 | | var height = target.SizeY; |
| | 106 | |
|
| | 107 | | // x direction |
| 0 | 108 | | for (var y = 0; y < height; ++y) |
| 0 | 109 | | { |
| 0 | 110 | | var start = targetRef[ComputeIndex(0, y)]; |
| 0 | 111 | | var sum = DefaultValue * _diameter; |
| | 112 | |
|
| 0 | 113 | | for (var x = 0; x < _width; x++) |
| 0 | 114 | | { |
| 0 | 115 | | var nrad = x - _radius - 1; |
| 0 | 116 | | var prad = x + _radius; |
| | 117 | |
|
| 0 | 118 | | var sub = nrad >= 0 ? targetRef[ComputeIndex(nrad, y)] : start; |
| 0 | 119 | | var add = prad < _width ? targetRef[ComputeIndex(prad, y)] : targetRef[ComputeIndex(_width - 1, y)]; |
| | 120 | |
|
| 0 | 121 | | sum -= sub.IsValid ? sub.Z : DefaultValue; |
| 0 | 122 | | sum += add.IsValid ? add.Z : DefaultValue; |
| | 123 | |
|
| 0 | 124 | | targetRef[ComputeIndex(x, y)].Z = sum / _diameter; |
| 0 | 125 | | } |
| 0 | 126 | | } |
| | 127 | |
|
| | 128 | | // y direction |
| 0 | 129 | | for (var x = 0; x < _width; ++x) |
| 0 | 130 | | { |
| 0 | 131 | | var start = targetRef[ComputeIndex(x, 0)]; |
| 0 | 132 | | var sum = DefaultValue * _diameter; |
| | 133 | |
|
| 0 | 134 | | for (var y = 0; y < height; y++) |
| 0 | 135 | | { |
| 0 | 136 | | var nrad = y - _radius - 1; |
| 0 | 137 | | var prad = y + _radius; |
| | 138 | |
|
| 0 | 139 | | var sub = nrad >= 0 ? targetRef[ComputeIndex(x, nrad)] : start; |
| 0 | 140 | | var add = prad < height ? targetRef[ComputeIndex(x, prad)] : targetRef[ComputeIndex(x, height - 1)]; |
| | 141 | |
|
| 0 | 142 | | sum -= sub.IsValid ? sub.Z : DefaultValue; |
| 0 | 143 | | sum += add.IsValid ? add.Z : DefaultValue; |
| | 144 | |
|
| 0 | 145 | | targetRef[ComputeIndex(x, y)].Z = sum / _diameter; |
| 0 | 146 | | } |
| 0 | 147 | | } |
| 0 | 148 | | } |
| | 149 | |
|
| | 150 | | /// <summary> |
| | 151 | | /// Filters highly frequented changes in a field of <see cref="ReFlex.Core.Common.Components.Point3"/>. |
| | 152 | | /// </summary> |
| | 153 | | public void FilterOptimized2(PointCloud3 target) |
| 0 | 154 | | { |
| 0 | 155 | | var targetRef = target.AsArray().AsSpan(); |
| 0 | 156 | | _width = target.SizeX; |
| 0 | 157 | | var height = target.SizeY; |
| | 158 | |
|
| | 159 | | // x direction |
| 0 | 160 | | for (var y = 0; y < height; ++y) |
| 0 | 161 | | { |
| 0 | 162 | | var start = targetRef[ComputeIndex(0, y)]; |
| 0 | 163 | | var sum = DefaultValue * _diameter; |
| | 164 | |
|
| 0 | 165 | | for (var x = 0; x < _width; x++) |
| 0 | 166 | | { |
| 0 | 167 | | var nrad = x - _radius - 1; |
| 0 | 168 | | var prad = x + _radius; |
| | 169 | |
|
| 0 | 170 | | var sub = nrad >= 0 ? targetRef[ComputeIndex(nrad, y)] : start; |
| 0 | 171 | | var add = prad < _width ? targetRef[ComputeIndex(prad, y)] : targetRef[ComputeIndex(_width - 1, y)]; |
| | 172 | |
|
| 0 | 173 | | sum -= sub.IsValid ? sub.Z : DefaultValue; |
| 0 | 174 | | sum += add.IsValid ? add.Z : DefaultValue; |
| | 175 | |
|
| 0 | 176 | | targetRef[ComputeIndex(x, y)].Z = sum / _diameter; |
| 0 | 177 | | } |
| 0 | 178 | | } |
| | 179 | |
|
| | 180 | | // y direction |
| 0 | 181 | | for (var x = 0; x < _width; ++x) |
| 0 | 182 | | { |
| 0 | 183 | | var start = targetRef[ComputeIndex(x, 0)]; |
| 0 | 184 | | var sum = DefaultValue * _diameter; |
| | 185 | |
|
| 0 | 186 | | for (var y = 0; y < height; y++) |
| 0 | 187 | | { |
| 0 | 188 | | var nrad = y - _radius - 1; |
| 0 | 189 | | var prad = y + _radius; |
| | 190 | |
|
| 0 | 191 | | var sub = nrad >= 0 ? targetRef[ComputeIndex(x, nrad)] : start; |
| 0 | 192 | | var add = prad < height ? targetRef[ComputeIndex(x, prad)] : targetRef[ComputeIndex(x, height - 1)]; |
| | 193 | |
|
| 0 | 194 | | sum -= sub.IsValid ? sub.Z : DefaultValue; |
| 0 | 195 | | sum += add.IsValid ? add.Z : DefaultValue; |
| | 196 | |
|
| 0 | 197 | | targetRef[ComputeIndex(x, y)].Z = sum / _diameter; |
| 0 | 198 | | } |
| 0 | 199 | | } |
| 0 | 200 | | } |
| | 201 | |
|
| | 202 | | /// <summary> |
| | 203 | | /// Filters highly frequented changes in a field of <see cref="ReFlex.Core.Common.Components.Point3"/>. |
| | 204 | | /// </summary> |
| | 205 | | public void FilterOptimized3(PointCloud3 target) |
| 0 | 206 | | { |
| 0 | 207 | | var targetRef = target.AsArray(); |
| 0 | 208 | | _width = target.SizeX; |
| 0 | 209 | | var height = target.SizeY; |
| | 210 | |
|
| | 211 | | // x direction |
| 0 | 212 | | for (var y = 0; y < height; ++y) |
| 0 | 213 | | { |
| 0 | 214 | | var start = targetRef[ComputeIndex(0, y)]; |
| 0 | 215 | | var sum = DefaultValue * _diameter; |
| | 216 | |
|
| 0 | 217 | | for (var x = 0; x < _width; x++) |
| 0 | 218 | | { |
| 0 | 219 | | var nrad = x - _radius - 1; |
| 0 | 220 | | var prad = x + _radius; |
| | 221 | |
|
| 0 | 222 | | var sub = nrad >= 0 ? targetRef[ComputeIndex(nrad, y)] : start; |
| 0 | 223 | | var add = prad < _width ? targetRef[ComputeIndex(prad, y)] : targetRef[ComputeIndex(_width - 1, y)]; |
| | 224 | |
|
| 0 | 225 | | sum -= sub.IsValid ? sub.Z : DefaultValue; |
| 0 | 226 | | sum += add.IsValid ? add.Z : DefaultValue; |
| | 227 | |
|
| 0 | 228 | | targetRef[ComputeIndex(x, y)].Z = sum / _diameter; |
| 0 | 229 | | } |
| 0 | 230 | | } |
| | 231 | |
|
| | 232 | | // y direction |
| 0 | 233 | | for (var x = 0; x < _width; ++x) |
| 0 | 234 | | { |
| 0 | 235 | | var start = targetRef[ComputeIndex(x, 0)]; |
| 0 | 236 | | var sum = DefaultValue * _diameter; |
| | 237 | |
|
| 0 | 238 | | for (var y = 0; y < height; y++) |
| 0 | 239 | | { |
| 0 | 240 | | var nrad = y - _radius - 1; |
| 0 | 241 | | var prad = y + _radius; |
| | 242 | |
|
| 0 | 243 | | var sub = nrad >= 0 ? targetRef[ComputeIndex(x, nrad)] : start; |
| 0 | 244 | | var add = prad < height ? targetRef[ComputeIndex(x, prad)] : targetRef[ComputeIndex(x, height - 1)]; |
| | 245 | |
|
| 0 | 246 | | sum -= sub.IsValid ? sub.Z : DefaultValue; |
| 0 | 247 | | sum += add.IsValid ? add.Z : DefaultValue; |
| | 248 | |
|
| 0 | 249 | | targetRef[ComputeIndex(x, y)].Z = sum / _diameter; |
| 0 | 250 | | } |
| 0 | 251 | | } |
| 0 | 252 | | } |
| | 253 | |
|
| | 254 | |
|
| | 255 | | /// <summary> |
| | 256 | | /// Sets the radius and calculates the diameter. |
| | 257 | | /// </summary> |
| | 258 | | /// <param name="radius">The radius.</param> |
| | 259 | | private void SetRadius(int radius) |
| 0 | 260 | | { |
| 0 | 261 | | _radius = radius; |
| 0 | 262 | | _diameter = radius * 2 + 1; |
| 0 | 263 | | } |
| | 264 | |
|
| | 265 | | private int ComputeIndex(int x, int y) |
| 0 | 266 | | { |
| 0 | 267 | | return x * _width + y; |
| 0 | 268 | | } |
| | 269 | |
|
| | 270 | | #endregion |
| | 271 | | } |