spi_control.py

# この作品はMITライセンスの下で提供されています。
# Copyright (c) 2013-2026 OpenMV LLC. 全著作権所有。
# https://github.com/openmv/openmv/blob/master/LICENSE
#
# SPI制御
#
# この例では、内蔵のLCDシールドドライバを使わずに、OpenMV CamのSPIバスを使って
# 内蔵のlcdシールドドライバを使わずにLCDシールドを駆動します。この例を実行するには
# LCDシールドが必要です。

import csi
import time
import struct
from machine import Pin, SPI

WIDTH = 128
HEIGHT = 160

cs = Pin("P3", Pin.OUT)
rst = Pin("P7", Pin.OUT)
rs = Pin("P8", Pin.OUT)
# OpenMV N6 LCDシールドのハードウェアSPIバスはSPIバス2です。

spi = SPI(2, baudrate=15000000, polarity=0, phase=0)


def write_command_byte(c):
    cs.low()
    rs.low()
    spi.write(bytes([c]))
    cs.high()


def write_data_byte(c):
    cs.low()
    rs.high()
    spi.write(bytes([c]))
    cs.high()


def write_command(c, *data):
    write_command_byte(c)
    if data:
        for d in data:
            write_data_byte(d)


def write_image(img):
    # LCDコントローラはRGB565を上位バイトから先に受け取ることを期待しますが、
    # OpenMVの画像はRGB565をリトルエンディアンのuint16として保持しているため、
    # ピクセルを送信する前にバイトを入れ替える必要があります。
    pixels = struct.unpack("H" * (img.size() // 2), img)
    swapped = struct.pack(">" + "H" * len(pixels), *pixels)
    cs.low()
    rs.high()
    spi.write(swapped)
    cs.high()


# LCDをリセットします。
rst.low()
time.sleep_ms(100)
rst.high()
time.sleep_ms(100)

write_command(0x11)  # スリープ解除
time.sleep_ms(120)

# メモリデータアクセス制御
# BGRモードにするには0xC8を書き込みます。
write_command(0x36, 0xC0)

# インターフェースピクセルフォーマット
write_command(0x3A, 0x05)

# ディスプレイオン
write_command(0x29)

csi0 = csi.CSI()
csi0.reset()  # カメラセンサーを初期化します。
csi0.pixformat(csi.RGB565)
csi0.framesize(csi.QVGA)  # OpenMV N6では320x200。
csi0.snapshot(time=2000)  # 新しい設定を反映させます。

# 320x200フレームの中央から、（128x160 LCDのアスペクト比に合わせた）4:5領域を
# 切り出し、それをLCDサイズに縮小します。
ROI = ((320 - 160) // 2, 0, 160, 200)
SCALE = WIDTH / ROI[2]

clock = time.clock()  # FPSを計測します。

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

    # img.scale()はまずソースのROIを切り出してからスケーリングします。
    img = img.scale(roi=ROI, x_scale=SCALE, y_scale=SCALE)

    write_command(0x2C)  # 画像書き込みコマンド...
    write_image(img)

    print(clock.fps())  # 注: OpenMV Camは接続時、速度が約半分になります
    # コンピュータに接続されている間。切断するとFPSは向上します。