landmarkの位置をworld座標にします。
landmark
CameraやLiDARなどは買うとします。
距離と向きは取得できるとします。
LiDARの位置はrobotのどこかに固定とします。
LiDARの位置はrobot中心に座標系変換できているとします。
robot中心からlandmarkまでの距離を\(l\)とします。
robotの向きからlandmarkの見える角度が\(\psi\)あるとします。
直交座標系に分解するので下記となります。
\[
y^{\prime\prime}=l\sin(\theta+\psi)
\]
\[
x^{\prime\prime}=l\cos(\theta+\psi)
\]
これはrobot中心からの\(x\)と\(y\)なのでrobot中心のworld座標系の位置を下記として
\[
\begin{pmatrix}
x \\
y
\end{pmatrix}
\]
landmarkのworld座標系の位置です。
\[
y^{\prime}=l\sin(\theta+\psi)+y
\]
\[
x^{\prime}=l\cos(\theta+\psi)+x
\]
広告
IT開発関連書とビジネス書が豊富な翔泳社の通販『SEshop』![](https://www12.a8.net/0.gif?a8mat=356SUU+1823JM+407E+5YJRM)
さくらのレンタルサーバ
![](https://www19.a8.net/0.gif?a8mat=2ZN7UA+4P34KY+D8Y+67RK2)
ムームードメイン
![](https://www16.a8.net/0.gif?a8mat=2ZN7UA+4UG10Y+348+1BNBJM)
Oisix(おいしっくす)
![](https://www17.a8.net/0.gif?a8mat=35H9RO+40OCS2+3RK+2T8BZM)
らでぃっしゅぼーや
![](https://www17.a8.net/0.gif?a8mat=35H9RT+5I9D82+1YGO+1ZIL6Q)
珈琲きゃろっと
![](https://www13.a8.net/0.gif?a8mat=3T0BIX+5TKLPU+2CG0+5YJRM)
エプソムソルト
![](https://www13.a8.net/0.gif?a8mat=3T4CGA+8AA6UQ+R12+609HU)