tf-pose-estimation を用いた姿勢推定でのリアルタイムでの座標取得

Question

前提

Python初心者です。

https://cam-inc.co.jp/p/techblog/603142844403680193

この記事を参考に姿勢推定を行いました。
座標取得を行いたいのですが記事にあるコードをサンプルコードのどこに差し込めばいいのかわかりませんでした。

実現したいこと

リアルタイムで姿勢推定を行っているときの座標取得
取得した座標をcsvファイルに書き込み　

発生している問題・エラーメッセージ

エラーメッセージ

該当のソースコード

import argparse
import logging
import time

import cv2
import numpy as np

from tf_pose.estimator import TfPoseEstimator
from tf_pose.networks import get_graph_path, model_wh

logger = logging.getLogger('TfPoseEstimator-WebCam')
logger.setLevel(logging.DEBUG)
ch = logging.StreamHandler()
ch.setLevel(logging.DEBUG)
formatter = logging.Formatter('[%(asctime)s] [%(name)s] [%(levelname)s] %(message)s')
ch.setFormatter(formatter)
logger.addHandler(ch)

fps_time = 0


if __name__ == '__main__':
    parser = argparse.ArgumentParser(description='tf-pose-estimation realtime webcam')
    parser.add_argument('--camera', type=int, default=0)

    parser.add_argument('--resize', type=str, default='0x0',
                        help='if provided, resize images before they are processed. default=0x0, Recommends : 432x368 or 656x368 or 1312x736 ')
    parser.add_argument('--resize-out-ratio', type=float, default=4.0,
                        help='if provided, resize heatmaps before they are post-processed. default=1.0')

    parser.add_argument('--model', type=str, default='mobilenet_thin', help='cmu / mobilenet_thin / mobilenet_v2_large / mobilenet_v2_small')
    parser.add_argument('--show-process', type=bool, default=False,
                        help='for debug purpose, if enabled, speed for inference is dropped.')
    args = parser.parse_args()

    logger.debug('initialization %s : %s' % (args.model, get_graph_path(args.model)))
    w, h = model_wh(args.resize)
    if w > 0 and h > 0:
        e = TfPoseEstimator(get_graph_path(args.model), target_size=(w, h))
    else:
        e = TfPoseEstimator(get_graph_path(args.model), target_size=(432, 368))
    logger.debug('cam read+')
    cam = cv2.VideoCapture(args.camera)
    ret_val, image = cam.read()
    logger.info('cam image=%dx%d' % (image.shape[1], image.shape[0]))

    while True:
        ret_val, image = cam.read()

        logger.debug('image process+')
        humans = e.inference(image, resize_to_default=(w > 0 and h > 0), upsample_size=args.resize_out_ratio)

        logger.debug('postprocess+')
        image = TfPoseEstimator.draw_humans(image, humans, imgcopy=False)

        logger.debug('show+')
        cv2.putText(image,
                    "FPS: %f" % (1.0 / (time.time() - fps_time)),
                    (10, 10),  cv2.FONT_HERSHEY_SIMPLEX, 0.5,
                    (0, 255, 0), 2)
        cv2.imshow('tf-pose-estimation result', image)
        fps_time = time.time()
        if cv2.waitKey(1) == 27:
            break
        logger.debug('finished+')

    cv2.destroyAllWindows()

#追加したい部分（参考記事より抜粋）

# 座標を取得
# p = 関節の番号
def findPoint(humans, p):
  for human in humans:

    try:
      body_part = human.body_parts[p]
      parts = [0,0]

      # 座標を整数に切り上げで置換
      parts[0] = int(body_part.x * width + 0.5)
      parts[1] = int(body_part.y * height + 0.5)

      # parts = [x座標, y座標]
      return parts

補足情報（FW/ツールのバージョンなど）

ここにより詳細な情報を記載してください。

Comments

[fourteenlength]

> 座標取得を
画像中の座標ですか？推定値でもよいのでメートル単位でのカメラからの距離座標ですか？

参考：googleのmediapipeであればCPUの処理だけでリアルタイムに両方とも算出できて幸せになれます。
https://google.github.io/mediapipe/solutions/pose.html