358 lines
12 KiB
C#
358 lines
12 KiB
C#
#if !(PLATFORM_LUMIN && !UNITY_EDITOR)
|
|
|
|
#if !UNITY_WSA_10_0
|
|
|
|
using OpenCVForUnity.CoreModule;
|
|
using OpenCVForUnity.DnnModule;
|
|
using OpenCVForUnity.ImgprocModule;
|
|
using OpenCVForUnity.UnityUtils;
|
|
using OpenCVForUnity.UnityUtils.Helper;
|
|
using System;
|
|
using System.Collections;
|
|
using System.Collections.Generic;
|
|
using UnityEngine;
|
|
using UnityEngine.SceneManagement;
|
|
|
|
namespace OpenCVForUnityExample
|
|
{
|
|
/// <summary>
|
|
/// LightweightPoseEstimation WebCam Example
|
|
/// An example of DNN inference with a lightweight person pose estimation model using the KeypointsModel class.
|
|
/// </summary>
|
|
[RequireComponent(typeof(WebCamTextureToMatHelper))]
|
|
public class LightweightPoseEstimationWebCamExample : MonoBehaviour
|
|
{
|
|
|
|
/// <summary>
|
|
/// The texture.
|
|
/// </summary>
|
|
Texture2D texture;
|
|
|
|
/// <summary>
|
|
/// The webcam texture to mat helper.
|
|
/// </summary>
|
|
WebCamTextureToMatHelper webCamTextureToMatHelper;
|
|
|
|
/// <summary>
|
|
/// The FPS monitor.
|
|
/// </summary>
|
|
FpsMonitor fpsMonitor;
|
|
|
|
|
|
Net net;
|
|
|
|
KeypointsModel keypointsModel;
|
|
|
|
const float inWidth = 256;
|
|
const float inHeight = 256;
|
|
|
|
const float inScale = 1.0f / 255f;
|
|
|
|
double[] inMean = new double[] { 128.0, 128.0, 128.0 };
|
|
|
|
double threshold = 0.1;
|
|
|
|
Dictionary<string, int> BODY_PARTS = new Dictionary<string, int>() {
|
|
{ "Nose", 0 }, { "Neck", 1 }, { "RShoulder", 2 }, { "RElbow", 3 }, {
|
|
"RWrist",
|
|
4
|
|
},
|
|
{ "LShoulder",5 }, { "LElbow", 6 }, { "LWrist", 7 }, { "RHip", 8 }, {
|
|
"RKnee",
|
|
9
|
|
},
|
|
{ "RAnkle", 10 }, { "LHip", 11 }, { "LKnee", 12 }, { "LAnkle", 13 }, {
|
|
"REye",
|
|
14
|
|
},
|
|
{ "LEye", 15 }, { "REar", 16 }, { "LEar", 17 }, {
|
|
"Background",
|
|
18
|
|
}
|
|
};
|
|
|
|
string[,] POSE_PAIRS = new string[,] {
|
|
{ "Neck", "RShoulder" }, { "Neck", "LShoulder" }, {
|
|
"RShoulder",
|
|
"RElbow"
|
|
},
|
|
{ "RElbow", "RWrist" }, { "LShoulder", "LElbow" }, {
|
|
"LElbow",
|
|
"LWrist"
|
|
},
|
|
{ "Neck", "RHip" }, { "RHip", "RKnee" }, { "RKnee", "RAnkle" }, {
|
|
"Neck",
|
|
"LHip"
|
|
},
|
|
{ "LHip", "LKnee" }, { "LKnee", "LAnkle" }, { "Neck", "Nose" }, {
|
|
"Nose",
|
|
"REye"
|
|
},
|
|
{ "REye", "REar" }, { "Nose", "LEye" }, { "LEye", "LEar" }
|
|
};
|
|
|
|
|
|
/// <summary>
|
|
/// MODEL_FILENAME
|
|
/// </summary>
|
|
string MODEL_FILENAME = "OpenCVForUnity/dnn/lightweight_pose_estimation_201912.onnx";
|
|
|
|
/// <summary>
|
|
/// The model filepath.
|
|
/// </summary>
|
|
string model_filepath;
|
|
|
|
#if UNITY_WEBGL
|
|
IEnumerator getFilePath_Coroutine;
|
|
#endif
|
|
|
|
// Use this for initialization
|
|
void Start()
|
|
{
|
|
fpsMonitor = GetComponent<FpsMonitor>();
|
|
|
|
webCamTextureToMatHelper = gameObject.GetComponent<WebCamTextureToMatHelper>();
|
|
|
|
|
|
#if UNITY_WEBGL
|
|
getFilePath_Coroutine = GetFilePath();
|
|
StartCoroutine(getFilePath_Coroutine);
|
|
#else
|
|
model_filepath = Utils.getFilePath(MODEL_FILENAME);
|
|
Run();
|
|
#endif
|
|
}
|
|
|
|
#if UNITY_WEBGL
|
|
private IEnumerator GetFilePath()
|
|
{
|
|
|
|
var getFilePathAsync_0_Coroutine = Utils.getFilePathAsync(MODEL_FILENAME, (result) =>
|
|
{
|
|
model_filepath = result;
|
|
});
|
|
yield return getFilePathAsync_0_Coroutine;
|
|
|
|
getFilePath_Coroutine = null;
|
|
|
|
Run();
|
|
}
|
|
#endif
|
|
|
|
// Use this for initialization
|
|
void Run()
|
|
{
|
|
|
|
//if true, The error log of the Native side OpenCV will be displayed on the Unity Editor Console.
|
|
Utils.setDebugMode(true);
|
|
|
|
net = null;
|
|
|
|
if (string.IsNullOrEmpty(model_filepath))
|
|
{
|
|
Debug.LogError(MODEL_FILENAME + " is not loaded. Please read “StreamingAssets/OpenCVForUnity/dnn/setup_dnn_module.pdf” to make the necessary setup.");
|
|
}
|
|
else
|
|
{
|
|
net = Dnn.readNet(model_filepath);
|
|
|
|
keypointsModel = new KeypointsModel(net);
|
|
keypointsModel.setInputScale(inScale);
|
|
keypointsModel.setInputSize(new Size(inWidth, inHeight));
|
|
keypointsModel.setInputMean(new Scalar(inMean));
|
|
keypointsModel.setInputSwapRB(false);
|
|
keypointsModel.setInputCrop(false);
|
|
}
|
|
|
|
|
|
Utils.setDebugMode(false);
|
|
|
|
webCamTextureToMatHelper.Initialize();
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the webcam texture to mat helper initialized event.
|
|
/// </summary>
|
|
public void OnWebCamTextureToMatHelperInitialized()
|
|
{
|
|
Debug.Log("OnWebCamTextureToMatHelperInitialized");
|
|
|
|
Mat webCamTextureMat = webCamTextureToMatHelper.GetMat();
|
|
|
|
texture = new Texture2D(webCamTextureMat.cols(), webCamTextureMat.rows(), TextureFormat.RGB24, false);
|
|
Utils.matToTexture2D(webCamTextureMat, texture);
|
|
|
|
gameObject.GetComponent<Renderer>().material.mainTexture = texture;
|
|
|
|
gameObject.transform.localScale = new Vector3(webCamTextureMat.cols(), webCamTextureMat.rows(), 1);
|
|
Debug.Log("Screen.width " + Screen.width + " Screen.height " + Screen.height + " Screen.orientation " + Screen.orientation);
|
|
|
|
if (fpsMonitor != null)
|
|
{
|
|
//fpsMonitor.Add("deviceName", webCamTextureToMatHelper.GetDeviceName().ToString());
|
|
fpsMonitor.Add("width", webCamTextureToMatHelper.GetWidth().ToString());
|
|
fpsMonitor.Add("height", webCamTextureToMatHelper.GetHeight().ToString());
|
|
//fpsMonitor.Add("videoRotationAngle", webCamTextureToMatHelper.GetWebCamTexture().videoRotationAngle.ToString());
|
|
//fpsMonitor.Add("videoVerticallyMirrored", webCamTextureToMatHelper.GetWebCamTexture().videoVerticallyMirrored.ToString());
|
|
//fpsMonitor.Add("camera fps", webCamTextureToMatHelper.GetFPS().ToString());
|
|
//fpsMonitor.Add("isFrontFacing", webCamTextureToMatHelper.IsFrontFacing().ToString());
|
|
//fpsMonitor.Add("rotate90Degree", webCamTextureToMatHelper.rotate90Degree.ToString());
|
|
//fpsMonitor.Add("flipVertical", webCamTextureToMatHelper.flipVertical.ToString());
|
|
//fpsMonitor.Add("flipHorizontal", webCamTextureToMatHelper.flipHorizontal.ToString());
|
|
fpsMonitor.Add("orientation", Screen.orientation.ToString());
|
|
}
|
|
|
|
|
|
float width = webCamTextureMat.width();
|
|
float height = webCamTextureMat.height();
|
|
|
|
float widthScale = (float)Screen.width / width;
|
|
float heightScale = (float)Screen.height / height;
|
|
if (widthScale < heightScale)
|
|
{
|
|
Camera.main.orthographicSize = (width * (float)Screen.height / (float)Screen.width) / 2;
|
|
}
|
|
else
|
|
{
|
|
Camera.main.orthographicSize = height / 2;
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the webcam texture to mat helper disposed event.
|
|
/// </summary>
|
|
public void OnWebCamTextureToMatHelperDisposed()
|
|
{
|
|
Debug.Log("OnWebCamTextureToMatHelperDisposed");
|
|
|
|
if (texture != null)
|
|
{
|
|
Texture2D.Destroy(texture);
|
|
texture = null;
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the webcam texture to mat helper error occurred event.
|
|
/// </summary>
|
|
/// <param name="errorCode">Error code.</param>
|
|
public void OnWebCamTextureToMatHelperErrorOccurred(WebCamTextureToMatHelper.ErrorCode errorCode)
|
|
{
|
|
Debug.Log("OnWebCamTextureToMatHelperErrorOccurred " + errorCode);
|
|
|
|
if (fpsMonitor != null)
|
|
{
|
|
fpsMonitor.consoleText = "ErrorCode: " + errorCode;
|
|
}
|
|
}
|
|
|
|
// Update is called once per frame
|
|
void Update()
|
|
{
|
|
if (webCamTextureToMatHelper.IsPlaying() && webCamTextureToMatHelper.DidUpdateThisFrame())
|
|
{
|
|
|
|
Mat img = webCamTextureToMatHelper.GetMat();
|
|
|
|
|
|
if (net == null)
|
|
{
|
|
Imgproc.putText(img, "model file is not loaded.", new Point(5, img.rows() - 30), Imgproc.FONT_HERSHEY_SIMPLEX, 0.7, new Scalar(255, 255, 255), 2, Imgproc.LINE_AA, false);
|
|
Imgproc.putText(img, "Please read console message.", new Point(5, img.rows() - 10), Imgproc.FONT_HERSHEY_SIMPLEX, 0.7, new Scalar(255, 255, 255), 2, Imgproc.LINE_AA, false);
|
|
}
|
|
else
|
|
{
|
|
List<Point> points = keypointsModel.estimate(img, (float)threshold).toList();
|
|
|
|
for (int i = 0; i < POSE_PAIRS.GetLength(0); i++)
|
|
{
|
|
string partFrom = POSE_PAIRS[i, 0];
|
|
string partTo = POSE_PAIRS[i, 1];
|
|
|
|
int idFrom = BODY_PARTS[partFrom];
|
|
int idTo = BODY_PARTS[partTo];
|
|
|
|
if (points[idFrom] != null && points[idTo] != null)
|
|
{
|
|
Imgproc.line(img, points[idFrom], points[idTo], new Scalar(0, 255, 0), 3);
|
|
Imgproc.ellipse(img, points[idFrom], new Size(3, 3), 0, 0, 360, new Scalar(0, 0, 255), Core.FILLED);
|
|
Imgproc.ellipse(img, points[idTo], new Size(3, 3), 0, 0, 360, new Scalar(0, 0, 255), Core.FILLED);
|
|
}
|
|
}
|
|
}
|
|
|
|
Imgproc.cvtColor(img, img, Imgproc.COLOR_BGR2RGB);
|
|
|
|
//Imgproc.putText (img, "W:" + img.width () + " H:" + img.height () + " SO:" + Screen.orientation, new Point (5, img.rows () - 10), Imgproc.FONT_HERSHEY_SIMPLEX, 1.0, new Scalar (255, 255, 255, 255), 2, Imgproc.LINE_AA, false);
|
|
|
|
Utils.matToTexture2D(img, texture);
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the destroy event.
|
|
/// </summary>
|
|
void OnDestroy()
|
|
{
|
|
webCamTextureToMatHelper.Dispose();
|
|
|
|
if (keypointsModel != null)
|
|
keypointsModel.Dispose();
|
|
|
|
if (net != null)
|
|
net.Dispose();
|
|
|
|
#if UNITY_WEBGL
|
|
if (getFilePath_Coroutine != null)
|
|
{
|
|
StopCoroutine(getFilePath_Coroutine);
|
|
((IDisposable)getFilePath_Coroutine).Dispose();
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the back button click event.
|
|
/// </summary>
|
|
public void OnBackButtonClick()
|
|
{
|
|
SceneManager.LoadScene("OpenCVForUnityExample");
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the play button click event.
|
|
/// </summary>
|
|
public void OnPlayButtonClick()
|
|
{
|
|
webCamTextureToMatHelper.Play();
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the pause button click event.
|
|
/// </summary>
|
|
public void OnPauseButtonClick()
|
|
{
|
|
webCamTextureToMatHelper.Pause();
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the stop button click event.
|
|
/// </summary>
|
|
public void OnStopButtonClick()
|
|
{
|
|
webCamTextureToMatHelper.Stop();
|
|
}
|
|
|
|
/// <summary>
|
|
/// Raises the change camera button click event.
|
|
/// </summary>
|
|
public void OnChangeCameraButtonClick()
|
|
{
|
|
webCamTextureToMatHelper.requestedIsFrontFacing = !webCamTextureToMatHelper.requestedIsFrontFacing;
|
|
}
|
|
}
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif |