angle_parameter2.ipynb

{
 "cells": [
  {
   "cell_type": "code",
   "execution_count": 1,
   "metadata": {},
   "outputs": [],
   "source": [
    "# %pip install mediapipe opencv-python\n",
    "import cv2\n",
    "import mediapipe as mp\n",
    "import numpy as np\n",
    "import matplotlib.pyplot as plt\n",
    "import math\n",
    "mp_drawing = mp.solutions.drawing_utils\n",
    "mp_pose = mp.solutions.pose"
   ]
  },
  {
   "attachments": {},
   "cell_type": "markdown",
   "metadata": {},
   "source": [
    "### Calculating Angle between two vectors"
   ]
  },
  {
   "cell_type": "code",
   "execution_count": 33,
   "metadata": {},
   "outputs": [],
   "source": [
    "def calculate_angle(a, b, c):\n",
    "    a = np.array([a.x, a.y]) # Start\n",
    "    b = np.array([b.x, b.y]) # Mid\n",
    "    c = np.array([c.x, c.y]) # End\n",
    "    # print(a, b, c)\n",
    "    \n",
    "    radians = math.atan2(c[1]-b[1], c[0]-b[0]) - math.atan2(a[1]-b[1], a[0]-b[0])\n",
    "    angle = np.abs(radians*180.0/math.pi)\n",
    "    \n",
    "    if angle > 180.0:\n",
    "        angle = 360-angle\n",
    "        \n",
    "    return angle"
   ]
  },
  {
   "attachments": {},
   "cell_type": "markdown",
   "metadata": {},
   "source": [
    "### Exercise: Jumping Jacks"
   ]
  },
  {
   "cell_type": "code",
   "execution_count": 58,
   "metadata": {},
   "outputs": [
    {
     "name": "stdout",
     "output_type": "stream",
     "text": [
      "100.24636481321721 107.24248291095549 90.42633973895806 88.23559130820335\n"
     ]
    },
    {
     "name": "stderr",
     "output_type": "stream",
     "text": [
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n",
      "QObject::moveToThread: Current thread (0x24b8820) is not the object's thread (0x2f4c790).\n",
      "Cannot move to target thread (0x24b8820)\n",
      "\n"
     ]
    },
    {
     "name": "stdout",
     "output_type": "stream",
     "text": [
      "100.66958876863254 107.63733449050511 90.29430130905911 88.25141353074231\n",
      "100.89415563639272 108.18268724288471 90.33945803394676 88.22257084588564\n",
      "101.15420513556512 108.33107505510365 90.17206197109584 88.30283212439029\n",
      "101.09390274178458 108.5073873797063 90.23496111593232 88.22687962823893\n",
      "101.09108705825605 108.61371502756047 90.25985503358407 88.26099929703541\n",
      "100.9661525451167 108.6108570185548 90.27569163290968 88.25493561591742\n",
      "100.97258709062976 108.4789975006341 90.2874348983953 88.3031305498283\n",
      "100.81011174898578 108.30732230376864 90.31283093950645 88.24691158384576\n",
      "100.94782559797545 108.3047539629833 90.33508585191754 88.25458732258657\n",
      "100.80073541116775 108.26513909055069 90.2595621045117 88.29717088884307\n",
      "100.72215915274171 108.286371721839 90.21939461627454 88.32521136523904\n",
      "100.48477003561294 108.39936939526083 90.02663323327494 88.42416550521243\n",
      "100.28589182975492 108.31019443349567 89.85621807044896 88.57288137894136\n",
      "100.19476835714124 108.21479433612723 89.78041191015063 88.6486145577012\n",
      "100.04496821571172 108.04818963213626 89.69278300280683 88.70320035427517\n",
      "100.02595756011436 108.01796348677243 89.64056762310906 88.76642402918705\n",
      "99.95753330857224 107.91973689050289 89.66108889482194 88.78201482890707\n",
      "99.80981422679918 107.83534779170093 89.65274879893764 88.78230722126402\n",
      "99.89174353424562 107.8316639695613 89.6574707684195 88.78557535815051\n",
      "99.63921680057621 107.83363283694243 89.68231508440329 88.755861785224\n",
      "99.5291172243098 107.73749191363808 89.63998240944233 88.78587610921291\n",
      "102.81951357982484 109.01820618797395 90.10459072278917 88.56817978759663\n",
      "154.62540630213286 153.1255265075945 89.06488891021769 89.51396208957297\n",
      "122.04835022359148 121.68783149956585 85.27595325901419 93.23385105181247\n",
      "101.79560757230547 99.46284413239356 84.11471127890401 94.77961995966822\n",
      "98.92629866523947 91.13575230657328 75.27886792048935 119.48355403489525\n",
      "99.11141633281568 91.60999476507327 63.43463922617147 110.17437770296053\n",
      "97.62229760830263 93.07296014377663 76.7135148026376 100.5832081759895\n",
      "98.14356455982727 92.78370534109685 77.99327808931704 102.10478164798859\n",
      "98.41560154061636 92.75782492434064 82.35946076998307 97.31726357967534\n",
      "98.21428844240216 92.66936311411254 83.27797661918743 96.07616776691007\n",
      "97.62200807350342 93.11105828535838 82.37951585616291 97.34944065464057\n",
      "97.41415570886397 93.44212778970612 80.7565350214594 100.60300169858023\n",
      "98.13676162734197 93.2115013754539 81.06089964981466 99.64529261521601\n",
      "98.58857034484367 93.12743484487878 80.49000135771988 100.11981741268144\n",
      "98.74174768845222 92.99896103401905 80.5383676121981 99.68858476862489\n",
      "98.63199534434108 93.08309069794092 80.29095396060143 99.70319412842849\n",
      "98.7600304104115 92.96805639580984 80.21037242690572 99.44524309751452\n",
      "98.52777744416426 92.71824452307511 80.46971938969952 99.34639873118893\n",
      "98.40714428281836 92.59691905046823 81.22241418803326 98.69334568956049\n",
      "97.82719041760367 91.7826897475397 81.23586526628908 98.6615873613961\n",
      "97.53695090074314 90.95802285895333 81.53594682624332 100.69749103560041\n",
      "97.18496744945304 90.52635021878083 76.17813005597634 106.63034603329625\n",
      "95.3538568598741 87.24018142929482 82.6288080275446 100.79769602689261\n",
      "94.69247336180075 86.34660766262313 84.11401956531425 103.14568258905747\n",
      "94.977685688929 86.13094040650523 84.98123331564165 100.96416685272061\n",
      "95.75390679923157 87.12065416425656 84.13165428655283 98.38227581418778\n",
      "127.41582765525405 115.27550817016329 85.43462329728949 95.58704303094642\n",
      "137.7449480774278 167.79217149355108 86.87000169517391 93.29156510899494\n",
      "116.33719650848786 123.08525465996432 87.70395507023962 92.15845774833969\n",
      "105.05196093451946 107.50863925929428 87.80274896467756 91.5798084989744\n",
      "100.99878228592343 110.48831603442784 87.94628843319211 91.2456019619118\n",
      "100.78435400854215 109.04745502067472 88.18040697126273 91.43538740789172\n",
      "98.60883829543485 106.6350036406044 87.63777959980054 91.75160360322224\n",
      "97.7331095002732 106.40892401911418 87.93999371185824 91.45852783426297\n",
      "98.55754283929481 106.9719751512655 87.91296536682893 91.56020368575697\n",
      "99.17008863965027 107.2533503738955 87.66939536591991 91.86924942979996\n",
      "99.06272127712556 107.29071650190387 87.48784873324763 91.68800478200173\n",
      "98.88931406464454 106.83592103547883 87.37857785773856 91.75896085413484\n",
      "99.17009846024169 106.98110322124995 87.33720100921664 91.74403747633099\n",
      "99.35181614179756 106.72609691551 87.38653698722797 91.73024732800934\n",
      "99.20994586488446 106.90465674153799 87.46371967002007 91.59538058566682\n",
      "99.35576740126338 106.48160687384812 87.28603663415215 91.67465976545462\n",
      "99.27260746228409 105.77170398622773 87.29086143976937 91.42521700726826\n",
      "99.46537214409605 104.40446545085861 87.34994844781704 91.21737649018753\n",
      "99.3164612077432 104.20671201688572 87.33097392444621 91.18785369559383\n",
      "99.28877442070663 104.06692693970916 87.35184888454076 91.22912445347852\n",
      "99.26129306921386 104.18816323096186 87.36447441219946 91.22031894340662\n"
     ]
    }
   ],
   "source": [
    "cap = cv2.VideoCapture(0)\n",
    "# recording\n",
    "frame_width = int(cap.get(3))\n",
    "frame_height = int(cap.get(4))\n",
    "size = (frame_width, frame_height)\n",
    "record = cv2.VideoWriter('testing.avi', cv2.VideoWriter_fourcc(*'MJPG'), 10, size)\n",
    "# initialize counter\n",
    "counter = 0\n",
    "stage = None\n",
    "correct_pose = {'count': 0, 'match': False}\n",
    "pose_count = 0\n",
    "with mp_pose.Pose(min_detection_confidence=0.5, min_tracking_confidence=0.5) as pose:\n",
    "    while cap.isOpened():\n",
    "        ret, frame = cap.read()\n",
    "        if not ret:\n",
    "            print(\"Video ended\")\n",
    "            break\n",
    "        # the BGR image to RGB.\n",
    "        image = cv2.cvtColor(frame, cv2.COLOR_BGR2RGB)\n",
    "        image.flags.writeable = False\n",
    "        # Make detection\n",
    "        results = pose.process(image)\n",
    "        # Recolor back to BGR\n",
    "        image.flags.writeable = True\n",
    "        image = cv2.cvtColor(image, cv2.COLOR_RGB2BGR)\n",
    "        # Extract landmarks\n",
    "        try:\n",
    "            landmarks = results.pose_landmarks.landmark\n",
    "            # print(landmarks)\n",
    "            left_shoulder = landmarks[mp_pose.PoseLandmark.LEFT_SHOULDER.value]\n",
    "            left_elbow = landmarks[mp_pose.PoseLandmark.LEFT_ELBOW.value]\n",
    "            left_wrist = landmarks[mp_pose.PoseLandmark.LEFT_WRIST.value]\n",
    "\n",
    "            right_shoulder = landmarks[mp_pose.PoseLandmark.RIGHT_SHOULDER.value]\n",
    "            right_elbow = landmarks[mp_pose.PoseLandmark.RIGHT_ELBOW.value]\n",
    "            right_wrist = landmarks[mp_pose.PoseLandmark.RIGHT_WRIST.value]\n",
    "\n",
    "            left_hip = landmarks[mp_pose.PoseLandmark.LEFT_HIP.value]\n",
    "            left_knee = landmarks[mp_pose.PoseLandmark.LEFT_KNEE.value]\n",
    "            left_ankle = landmarks[mp_pose.PoseLandmark.LEFT_ANKLE.value]\n",
    "\n",
    "            right_hip = landmarks[mp_pose.PoseLandmark.RIGHT_HIP.value]\n",
    "            right_knee = landmarks[mp_pose.PoseLandmark.RIGHT_KNEE.value]\n",
    "            right_ankle = landmarks[mp_pose.PoseLandmark.RIGHT_ANKLE.value]\n",
    "\n",
    "            # calculating angle\n",
    "            left_angle1 = calculate_angle(left_shoulder, left_elbow, left_wrist)\n",
    "            left_angle2 = calculate_angle(left_hip, left_knee, left_ankle)\n",
    "            right_angle1 = calculate_angle(right_shoulder, right_elbow, right_wrist)\n",
    "            right_angle2 = calculate_angle(right_hip, right_knee, right_ankle)\n",
    "\n",
    "            pose_count += 1\n",
    "            if (left_angle1 > 150 and left_angle2 > 150) and (right_angle1 > 150 and right_angle2 > 150):\n",
    "                correct_pose['count'] += 1\n",
    "                correct_pose['match'] = True\n",
    "            else:\n",
    "                correct_pose['match'] = False\n",
    "            \n",
    "            angle1 = calculate_angle(left_elbow, left_shoulder, right_shoulder)\n",
    "            angle2 = calculate_angle(right_elbow, right_shoulder, left_shoulder)\n",
    "            angle3 = calculate_angle(right_hip, left_hip, left_knee)\n",
    "            angle4 = calculate_angle(left_hip, right_hip, right_knee)\n",
    "            print(angle1, angle2, angle3, angle4)\n",
    "            cv2.putText(image, str(round(angle1,1)), tuple(np.multiply([left_shoulder.x, left_shoulder.y], [frame_width, frame_height]).astype(int)), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (255, 255, 255), 2, cv2.LINE_AA)\n",
    "            cv2.putText(image, str(round(angle2,1)), tuple(np.multiply([right_shoulder.x, right_shoulder.y], [frame_width, frame_height]).astype(int)), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (255, 255, 255), 2, cv2.LINE_AA)\n",
    "            cv2.putText(image, str(round(angle3,1)), tuple(np.multiply([left_hip.x, left_hip.y],[frame_width, frame_height]).astype(int)), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (255, 255, 255), 2, cv2.LINE_AA)\n",
    "            cv2.putText(image, str(round(angle4,1)), tuple(np.multiply([right_hip.x, right_hip.y], [frame_width, frame_height]).astype(int)), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (255, 255, 255), 2, cv2.LINE_AA)\n",
    "            # count the reps\n",
    "            if angle2 < 100 and angle4 < 90:\n",
    "                stage = \"down\"\n",
    "            if angle2 > 160 and angle4 > 100 and stage == 'down':\n",
    "                stage = 'up'\n",
    "                counter += 1\n",
    "    \n",
    "        except Exception as e:\n",
    "            print(e)\n",
    "        # render\n",
    "        # status box    \n",
    "        if(correct_pose['match']):\n",
    "            color = (0, 255, 0)\n",
    "        else:\n",
    "            color = (0, 0, 255)\n",
    "        cv2.rectangle(image, (0,0), (frame_width, 70), color, -1)\n",
    "        # Reps\n",
    "        cv2.putText(image, 'REPS', (15,12), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (255,255,255), 1, cv2.LINE_AA)\n",
    "        cv2.putText(image, str(counter), (10,60), cv2.FONT_HERSHEY_SIMPLEX, 2, (255,255,255), 2, cv2.LINE_AA)\n",
    "        # Stage\n",
    "        cv2.putText(image, 'STAGE', (100,12), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (255,255,255), 1, cv2.LINE_AA)\n",
    "        cv2.putText(image, stage, (80,60), cv2.FONT_HERSHEY_SIMPLEX, 2, (255,255,255), 2, cv2.LINE_AA)\n",
    "        # posture\n",
    "        # cv2.putText(image, 'POSTURE', (175,12), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (255,255,255), 1, cv2.LINE_AA)\n",
    "        # cv2.putText(image, \"\\U0001f600\" if correct_pose['match'] else 'INCORRECT', (175,60), cv2.FONT_HERSHEY_SIMPLEX, 1, (255,255,255), 2, cv2.LINE_AA)\n",
    "        # print(stage)\n",
    "        mp_drawing.draw_landmarks(image, results.pose_landmarks, mp_pose.POSE_CONNECTIONS,\n",
    "                                    mp_drawing.DrawingSpec(color=(245,117,66), thickness=2, circle_radius=2),\n",
    "                                    mp_drawing.DrawingSpec(color=(245,66,230), thickness=2, circle_radius=2)\n",
    "                                    )\n",
    "                                    \n",
    "        cv2.imshow('Raw Webcam Feed', image)\n",
    "        record.write(image)\n",
    "        if cv2.waitKey(10) & 0xFF == ord('q'):\n",
    "            break\n",
    "cap.release()\n",
    "record.release()\n",
    "cv2.destroyAllWindows()"
   ]
  },
  {
   "cell_type": "code",
   "execution_count": 51,
   "metadata": {},
   "outputs": [
    {
     "name": "stdout",
     "output_type": "stream",
     "text": [
      "total reps: 2\n",
      "total correct pose: 94\n",
      "total pose: 134\n",
      "accuracy: 70.15\n"
     ]
    }
   ],
   "source": [
    "print(f\"total reps: {counter}\")\n",
    "print(f\"total correct pose: {correct_pose['count']}\")\n",
    "print(f\"total pose: {pose_count}\")\n",
    "print(f\"accuracy: {round(correct_pose['count']/pose_count * 100, 2)}\")"
   ]
  },
  {
   "cell_type": "code",
   "execution_count": null,
   "metadata": {},
   "outputs": [],
   "source": []
  }
 ],
 "metadata": {
  "kernelspec": {
   "display_name": "Python 3",
   "language": "python",
   "name": "python3"
  },
  "language_info": {
   "codemirror_mode": {
    "name": "ipython",
    "version": 3
   },
   "file_extension": ".py",
   "mimetype": "text/x-python",
   "name": "python",
   "nbconvert_exporter": "python",
   "pygments_lexer": "ipython3",
   "version": "3.10.7 (tags/v3.10.7:6cc6b13, Sep  5 2022, 14:08:36) [MSC v.1933 64 bit (AMD64)]"
  },
  "orig_nbformat": 4,
  "vscode": {
   "interpreter": {
    "hash": "06d27cae120c8794265ed279269c4c44da5cbce9399fe3541c085bdf7bc3ff29"
   }
  }
 },
 "nbformat": 4,
 "nbformat_minor": 2
}