Skip to content

Instantly share code, notes, and snippets.

@tejus-gupta
tejus-gupta / median_filter_multilevel.jl
Created October 9, 2018 15:25
Code for median filter based on 'A coarse-to-fine algorithm for fast median filtering of image data with a huge number of levels' by Alparone et al.
using Images, TestImages, Statistics, BenchmarkTools, Test
img = testimage("lena_gray")
function median_filter_multilevel(img::Array{Gray{Normed{T,f}}, 2}, window_size::Tuple{Int64,Int64}) where {T,f}
nlevels = 2^f
course_nlevels = 2^(f>>1)
bin_bits = f>>1

State lattice-based planning

tl;dr

The kinodynamics constraints of the robot are encoded in the state lattice graph and any path in this graph is feasible. After constructing the graph, any graph search algorithm can be used for planning.

Algorithm

A robot's configuration space is usually discretized to reduce computational complexity of planning at the expense of completeness. However, it is difficult to search this space while satisfying the robot's differential constraints. State lattices are a special way of discretization of robot state space that ensures (by construction) that any path in the graph complies with the robot's constraints, thereby eliminating the need to consider them explicitly during planning.