More than 1 year has passed since last update.

OBD2とPythonでシフトポジションを取る

Posted at 2022-07-08

まえおき

前回のあらすじを3行で〜
● ドライブ中にコペンのシフト位置が不安だからシフトインジケータ作ろ!
● OBD2でシフト位置を含めたクルマの情報取れるかチェックや！
● 車速とかは取れたけど，シフト位置は取れないや〜ん（泣）どうにかせな・・・

ということで今回はどうにかしてシフトポジションを取る方法を考える．
シフトインジケータ作成のロードマップで言えば，以下の部分を実施していく！

シフトポジションの取り方

コペンの場合，OBD2からPID164から直接取ることは不可能であった．（前回記事参照）
だが！車速とエンジン回転数，その他諸々の情報があれば，シフトポジションが取れることがわかった！参考にした記事

ギアポジションの特定に必要な情報は以下5つである．
※"[ ]"に後述する数式やコード内の変数名を記載する．

対象車の各ギアの変速比　 [LA400K_GEAR_RATION]
今回はコペン LA400KのMTが対象である．
公式のコペン主要諸元表(PDF)-ダイハツ工業の”トランスミッションー変速比”から取得可能ある．
最終減速比 [F]
上記資料の主要諸元表にある最終減速比が対象の値である．
車種が異なる場合は各車種の主要諸元表をぐぐって拾って欲しい．
タイヤ周径 [R]
ホイールを変えている場合は各自クルマのスペックから計算する．
コペンのノーマルタイヤは”165/50R16”（断面層/扁平率/インチ）である．
本計算サイトからタイヤの周径を計算可能である．
車速 [speed]
OBD2からリアルタイムで取得する
エンジン回転数 [rpm]
OBD2からリアルタイムで取得する

ギアポジションの特定方法として，その時の車速とエンジン回転数からギア比 [GearRation]を計算し，そのギア比に最も近い値のギアポジションを返す．
計算式としては以下の通りである．

上記のGearRationに最も近いギアポジションを返す！

難しいようなことを言っているようで全くムズかしくない．．．
（言語化するとムずくなる．．．）

ヨウスル二，ギア比を計算して，それがどのギアポジションの値なのか？を見てあげるだけである！

実装したコードを次章にて説明する．

ギアポジションの取得

上記の計算式をPythonに落とし込む．
コードは以下の通りである

gearPosition.py

###############################################
# 車速とエンジン回転数からギアポジションを取得
###############################################
import time
import numpy as np
import obd
from   obd import OBDStatus

###############################################
# 定数 CONST
# コペン LA400K（MT）の値
# 車種等が違う場合は値を変更する必要あり
###############################################
LA400K_GEAR_RATION = [ 3.181, # 1速
					   1.842, # 2速
					   1.250, # 3速
					   0.916, # 4速
					   0.750  # 5速
					 ]
R = 1.795                     # タイヤ周径
F = 5.545                     # 最終減速比

###############################################
# 関数 define
###############################################
def cal_gearPosition(gearRation):
	"""
	現在ギア比（gearRation）と変速比表（LA400K_GEAR_RATION）から
	現在ギア位置（gearPosition）を返す（変速比表から一番近いギア比のidxを返す）
	Input	: ギア比（gearRation）
	Output	: ギア位置（gearPosition）
	"""
	gearPosition = np.argmin(np.abs(np.array(LA400K_GEAR_RATION) - gearRation)) 
	gearPosition = gearPosition + 1 # idxが0から始まっているので+1
	return gearPosition

def cal_gearRation(rpm, speed):
	"""
	回転数（rpm）と車速（speed）からギア比（gearRation）を求める
	Input	: 回転数（rpm）, 車速（speed）
	Output	: ギア比（gearRation）
	"""
	gearRation = R * rpm / (speed * F) * 60 / 1000
	return gearRation

###############################################
# メイン main
###############################################
if __name__ == '__main__':
	connection = obd.OBD()      # OBD2とコネクションを確立
	print (connection.status())

	if connection.status() == OBDStatus.CAR_CONNECTED:
		while(True):
			try:
				rpm   = connection.query(obd.commands.RPM).value.magnitude
				speed = connection.query(obd.commands.SPEED).value.magnitude

				if speed != 0: # speed=0だと除算でエラーが発生するため
					gearRation   = cal_gearRation(rpm, speed)        # ギア比を計算
					gearPosition = cal_gearPosition(gearRation)      # ギアポジションを計算
					print("GearPosition is {}".format(gearPosition)) # ギアポジションを表示
				else:
					gearRation   = 0
					gearPosition = 0
					print("speed is 0, cannot get GearPosition")
				time.sleep(.2) # 0.2s 停止

			except KeyboardInterrupt:
				pass

	connection.close()