Ecosyste.ms: Awesome

An open API service indexing awesome lists of open source software.

Awesome Lists | Featured Topics | Projects

https://github.com/knagara/SLAMwithCameraIMUforPython

SLAM with Camera and IMU (Python)
https://github.com/knagara/SLAMwithCameraIMUforPython

Last synced: 3 months ago
JSON representation

SLAM with Camera and IMU (Python)

Awesome Lists containing this project

README

        

# SLAM with Camera and IMU for Python
画像センサとIMUを用いたSLAMのためのPythonプログラム(日本語説明は後半)

>SLAM = Simultaneous Localization and Mapping

## Overview

[![](http://img.youtube.com/vi/IDZ5fxp_XdY/0.jpg)](https://www.youtube.com/watch?v=IDZ5fxp_XdY)

![](https://github.com/knagara/miscellaneous/blob/master/Overview.png)

- Android App (See -> [SLAMwithCameraIMUforAndroid](https://github.com/knagara/SLAMwithCameraIMUforAndroid))
- SLAM program (This page)
- MQTT Broker (See -> [MQTT](http://mqtt.org/), [mosquitto](http://mosquitto.org/), [Apollo](https://activemq.apache.org/apollo/))

## How to use
1.Setup Android App (See -> [SLAMwithCameraIMUforAndroid](https://github.com/knagara/SLAMwithCameraIMUforAndroid))

2.Setup MQTT Broker (See -> [MQTT](http://mqtt.org/), [mosquitto](http://mosquitto.org/), [Apollo](https://activemq.apache.org/apollo/))

3.Install MQTT package of Python
~~~
>pip install paho-mqtt
~~~
4.Create a single line text file named 'server.conf' on the parent directory of Main.py.
~~~
server.conf
[Format] ipaddress&port&username&password
[Example] 160.16.xxx.xxx&61613&admin&password
~~~
5.Run Main.py
~~~
>python Main.py
~~~
6.Start Android App

7.Now the program is receiving sensor data and estimate smartphone location, also publishing it to MQTT broker.

8.If you want to save estimated data as CSV, run GetOutputData.py
~~~
>python ./data/GetOutputData.py
~~~

## Important Files

|File name|Explanation|
|:--|:--|
|Main.py|The entry point of SLAM program
Receive sensor data
Publish estimated location|
|image_RBPF.py|Parse sensor data of camera|
|landmark.py|Landmark (Keypoint in 3D space) class
Initialize landmark parameters
Observation model|
|particle.py|Particle class|
|particle_filter_RBPF.py|Particle filter|
|sensor.py|Parse sensor data of IMU|
|state_RBPF.py|Manage state variable|
|data/GetOutputData.py|Receive estimated data and save them as CSV|

## Data Flow

![](https://github.com/knagara/miscellaneous/blob/master/dataflow_.png)



## 概要

[![](http://img.youtube.com/vi/IDZ5fxp_XdY/0.jpg)](https://www.youtube.com/watch?v=IDZ5fxp_XdY)

![](https://github.com/knagara/miscellaneous/blob/master/Overview.png)

- Androidアプリ(ここを参照 -> [SLAMwithCameraIMUforAndroid](https://github.com/knagara/SLAMwithCameraIMUforAndroid))
- SLAMプログラム(このページ)
- MQTTブローカー(ここを参照 -> [MQTTについて詳しく知る](https://sango.shiguredo.jp/mqtt), [MQTTについてのまとめ](http://tdoc.info/blog/2014/01/27/mqtt.html), [MQTT Broker比較](http://acro-engineer.hatenablog.com/entry/2015/12/09/120500))

## 使い方
1.Androidアプリをセットアップ(ここを参照 -> [SLAMwithCameraIMUforAndroid](https://github.com/knagara/SLAMwithCameraIMUforAndroid))

2.MQTTブローカーをセットアップ(ここを参照 -> [sango](https://sango.shiguredo.jp/))

3.PythonのMQTTパッケージをインストール
~~~
>pip install paho-mqtt
~~~
4.server.confという名前のファイルをMain.pyの親ディレクトリに作成する
~~~
server.conf
[フォーマット] ipaddress&port&username&password
[例] 160.16.xxx.xxx&61613&admin&password
~~~
5.Main.pyを起動
~~~
>python Main.py
~~~
6.Androidアプリを起動

7.センサデータを受信し、位置の推定が始まります。推定結果はMQTTブローカーに送信されます。

8.推定結果をCSVファイルに保存したい場合は、GetOutputData.pyを起動
~~~
>python ./data/GetOutputData.py
~~~

## 重要なファイル

|File name|Explanation|
|:--|:--|
|Main.py|SLAMプログラムのエントリポイント
センサデータの受信
推定結果の送信|
|image_RBPF.py|画像センサデータのパース|
|landmark.py|ランドマーク(3D空間中の特徴点)クラス
ランドマークのパラメータの初期化
観測モデル|
|particle.py|パーティクルクラス|
|particle_filter_RBPF.py|パーティクルフィルタ|
|sensor.py|IMUセンサデータのパース|
|state_RBPF.py|状態変数の管理|
|data/GetOutputData.py|推定結果を受信してCSVで保存|

## データフロー

![](https://github.com/knagara/miscellaneous/blob/master/dataflow_.png)