absolute-translation.py

# この作品はMITライセンスの下で提供されています。
# Copyright (c) 2013-2023 OpenMV LLC. 全著作権所有。
# https://github.com/openmv/openmv/blob/master/LICENSE
#
# 絶対オプティカルフロー 平行移動
#
# この例では、OpenMV Camを使って
# 現在の画像と直前の画像を比較することでX・Y方向の平行移動を計測する方法を示します。
# X・Y方向の平行移動のみが扱われ、
# このモードでは回転/スケールは扱われません。
#
# このデモを効果的に実行するには、OpenMV Camを安定した
# 台に固定した状態でゆっくりと左右上下に動かして
# 数値の変化を確認してください。変位の値は水平・垂直解像度の
# 約半分までプラスマイナスで表示されます。
#
# 注意: find_displacement()を使用する場合は、小さい2のべき乗の
# 解像度を使用する必要があります。これは、このアルゴリズムが
# 位相相関と呼ばれる手法によって動作しており、FFTを使って
# 画像比較を行うためです。2のべき乗でない解像度は、2のべき乗に
# パディングする必要があり、アルゴリズムの結果の有用性が低下します。
# B64X64やB64X32（2倍高速）のような解像度を使用してください。
#
# OpenMV Camは64x32、64x64、128x64、128x128の
# 2のべき乗解像度に対応しています。32x32の解像度が必要な場合は、
# 64x64画像に対して"img.scale(x_scale=0.5, y_scale=0.5, hint=image.AREA)"を実行することで作成できます。

import csi
import image
import time

csi0 = csi.CSI()
csi0.reset()  # センサーをリセットして初期化します。
csi0.pixformat(csi.RGB565)  # ピクセルフォーマットをRGB565（またはGRAYSCALE）に設定します
csi0.framesize((64, 64))  # フレームサイズを64x64（または64x32）に設定します……
csi0.snapshot(time=2000)  # 設定が反映されるまで待ちます。
clock = time.clock()  # FPSを計測するためのclockオブジェクトを作成します。

# ヒープ上に2つ目のフレームバッファを作成します。
extra_fb = image.Image(csi0.width(), csi0.height(), csi0.pixformat())
extra_fb.draw_image(csi0.snapshot())

while True:
    clock.tick()  # snapshot()呼び出し間の経過ミリ秒を計測します。
    img = csi0.snapshot()  # 画像を撮影して返します。

    # この例では、絶対的な変化を計測するために古い画像を更新しません。
    displacement = extra_fb.find_displacement(img)

    # オフセット結果はフィルタリングしないとノイズが多いため、精度を多少犠牲にします。
    sub_pixel_x = int(displacement.x_translation * 5) / 5.0
    sub_pixel_y = int(displacement.y_translation * 5) / 5.0

    if (
        displacement.response > 0.1
    ):  # 0.1程度を下回ると（環境によります）、結果は単なるノイズになります。
        print(
            "{0:+f}x {1:+f}y {2} {3} FPS".format(
                sub_pixel_x, sub_pixel_y, displacement.response, clock.fps()
            )
        )
    else:
        print(clock.fps())