added some comments. more to-do
This commit is contained in:
@@ -84,7 +84,7 @@
|
||||
\newcommand{\stepSize}{\mathcal{S}}
|
||||
This data structure yields room for various strategies to be applied within the transition step.
|
||||
The most simple approach uses an average pedestrian step size together with the
|
||||
number of detected steps $\mObsSteps$ together and change in heading $\mObsHeading$
|
||||
number of detected steps $\mObsSteps$ and change in heading $\mObsHeading$
|
||||
gathered from sensor observations $\mObsVec_{t-1}$.
|
||||
Combined with previously estimated position $(x,y)^T$ and heading $\mStateHeading$
|
||||
%from $\mStateVec_{t-1}$
|
||||
@@ -95,8 +95,9 @@
|
||||
%
|
||||
\begin{equation}
|
||||
\begin{aligned}
|
||||
x_t &=& \overbrace{x_{t-1}}^{\text{old pos.}}& & &+& \overbrace{\mObsSteps \cdot \stepSize}^{\text{distance}}& & &\cdot& \overbrace{\cos(\mStateHeading + \turnNoise)}^{\text{direction}}& & ,\enskip \turnNoise &\sim \mathcal{N}(\mObsHeading, \sigma_\text{turn}^2) \\
|
||||
y_t &=& y_{t-1}\phantom{.}& & &+& \mObsSteps \cdot \stepSize& & &\cdot& \sin(\mStateHeading + \turnNoise)& & ,\enskip \stepSize &\sim \mathcal{N}(\SI{70}{\centi\meter}, \sigma_\text{step}^2)
|
||||
x_t &=& \overbrace{x_{t-1}}^{\text{old pos.}}& & &+& \overbrace{\mObsSteps \cdot \stepSize}^{\text{distance}}& & &\cdot& \overbrace{\cos(\mStateHeading_{t})}^{\text{direction}}& & ,\enskip \turnNoise &\sim \mathcal{N}(\mObsHeading, \sigma_\text{turn}^2) \\
|
||||
y_t &=& y_{t-1}\phantom{.}& & &+& \mObsSteps \cdot \stepSize& & &\cdot& \sin(\mStateHeading_{t})& & ,\enskip \stepSize &\sim \mathcal{N}(\SI{70}{\centi\meter}, \sigma_\text{step}^2) \\
|
||||
\mStateHeading_{t} &=& \mStateHeading_{t-1} + \turnNoise\\
|
||||
\end{aligned}
|
||||
\end{equation}
|
||||
\noindent{}with
|
||||
@@ -105,7 +106,7 @@
|
||||
\enskip\enskip\enskip
|
||||
\text{and}
|
||||
\enskip\enskip\enskip
|
||||
x_{t-1},y_{t-1},\mStateHeading \in \mStateVec_{t-1}
|
||||
x_{t-1},y_{t-1},\mStateHeading_{t-1} \in \mStateVec_{t-1}
|
||||
\enskip.
|
||||
\end{equation*}
|
||||
|
||||
@@ -120,6 +121,6 @@
|
||||
that might be reachable. Increasing $\sigma_\text{step}$ and $\sigma_\text{turn}$ for those cases might also be a viable choice.
|
||||
Likewise, just using some random position, omitting heading/steps might be viable as well.
|
||||
|
||||
\commentByFrank{es gaebe noch ganz andere ansaetze etc. aber wir haben wohl nicht mehr genug platz :P}
|
||||
\commentByToni{ich denke aber auch, es langt.}
|
||||
%\commentByFrank{es gaebe noch ganz andere ansaetze etc. aber wir haben wohl nicht mehr genug platz :P}
|
||||
%\commentByToni{ich denke aber auch, es langt.}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user