distance_detector.ipynb

{
 "cells": [
  {
   "cell_type": "code",
   "execution_count": 1,
   "metadata": {},
   "outputs": [],
   "source": [
    "# capture image\n",
    "import time\n",
    "import cv2\n",
    "import os\n",
    "\n",
    "green = (0,255,0)\n",
    "red = (0,0,255)\n",
    "white = (255,255,255)\n",
    "fonts = cv2.FONT_HERSHEY_COMPLEX\n",
    "camera = cv2.VideoCapture(0)\n",
    "\n",
    "width = 1280\n",
    "height= 960\n",
    "camera.set(3,width)\n",
    "camera.set(4,height)\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "starting_time = time.time()\n",
    "Frame_Counter = 0\n",
    "Cap_frame = 0\n",
    "Dir_name = \"/home/srikanth/Desktop/Arihant/\"\n",
    "number_image_captured = 1\n",
    "capture_image = False\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "while True:\n",
    "    IsDirExist = os.path.exists(Dir_name)    # check if directory exists or not\n",
    "#     print(IsDirExist)\n",
    "        \n",
    "    if not IsDirExist: os.mkdir(Dir_name)    # if doesn't, create it        \n",
    "\n",
    "    #####################################################################\n",
    "        \n",
    "    Frame_Counter+=1\n",
    "    ret, frame = camera.read()               # read frames from camera    \n",
    "    ret, saving_frame = camera.read()        # read saving frame seperatly     \n",
    "    height, width, dim = saving_frame.shape  # find image width and height\n",
    "    # print(width, height, dim)\n",
    "    \n",
    "    #####################################################################\n",
    "\n",
    "#     cv2.putText(saving_frame,f\"Height: {height}\",(30,50),fonts,0.4,(0,255,0),1)\n",
    "#     cv2.putText(saving_frame,f\"Width:  {width}\",(30,70),fonts,0.4,(0,255,0),1)\n",
    "\n",
    "    #####################################################################\n",
    "    \n",
    "# capture frame if capture_image is true and number_image_captured < 10\n",
    "    if capture_image==True and Cap_frame < number_image_captured:\n",
    "        Cap_frame+=1\n",
    "        cv2.putText(frame,'Capturing',(50,70),fonts,2,green,1)\n",
    "        cv2.imwrite(f\"{Dir_name}/frame-{Cap_frame}.png\", saving_frame)\n",
    "    else:\n",
    "        cv2.putText(frame,'Not Capturing',(50,70),fonts,2,red,1)\n",
    "        Cap_frame = 0\n",
    "        capture_image =False\n",
    "    cv2.imshow(\"frame\", frame)\n",
    "    cv2.imshow(\"saving Image\", saving_frame)\n",
    "    total_time = time.time()\n",
    "    frame_time = total_time - starting_time\n",
    "\n",
    "    #####################################################################\n",
    "    \n",
    "    fps = Frame_Counter/frame_time\n",
    "    # print(fps)\n",
    "    # print(capture_image)\n",
    "    \n",
    "    #####################################################################\n",
    "\n",
    "#     if cv2.waitKey(1) == ord('q'): break\n",
    "    \n",
    "    if cv2.waitKey(1)==27: break    # esc\n",
    "\n",
    "    if cv2.waitKey(1)==ord('c'): capture_image = True    # capture image        \n",
    "        \n",
    "#########################################################################\n",
    "\n",
    "camera.release()\n",
    "cv2.destroyAllWindows()"
   ]
  },
  {
   "cell_type": "code",
   "execution_count": 13,
   "metadata": {},
   "outputs": [],
   "source": [
    "# measure distance\n",
    "import cv2\n",
    "\n",
    "green = (0,255,0)\n",
    "red = (0,0,255)\n",
    "white = (255,255,255)\n",
    "fonts = cv2.FONT_HERSHEY_COMPLEX\n",
    "cap = cv2.VideoCapture(0)\n",
    "\n",
    "width = 1280\n",
    "height= 960\n",
    "cap.set(3,width)\n",
    "cap.set(4,height)\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "KNOWN_DISTANCE = 160    # distance from camera to object(face) in centimeter\n",
    "KNOWN_WIDTH = 4.3     # width of face in the real world in centimeter\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "# face detector object\n",
    "face_detector = cv2.CascadeClassifier(\"haarcascade_frontalface_default.xml\")\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "# focal length finder function\n",
    "def focal_length(measured_distance, real_width, width_in_rf_image):    \n",
    "    focal_length_value = (width_in_rf_image * measured_distance) / real_width\n",
    "    return focal_length_value\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "# distance estimation function\n",
    "def distance_finder(focal_length, real_face_width, face_width_in_frame):    \n",
    "    distance = (real_face_width * focal_length) / face_width_in_frame\n",
    "    return distance\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "# face detector function\n",
    "def face_data(image):\n",
    "    face_width = 0\n",
    "    gray_image = cv2.cvtColor(image, cv2.COLOR_BGR2GRAY)\n",
    "    faces = face_detector.detectMultiScale(gray_image, 1.3, 5)\n",
    "    for (x,y,h,w) in faces:\n",
    "        cv2.rectangle(image,(x,y),(x+w, y+h),white,1)\n",
    "        face_width = w\n",
    "\n",
    "    return face_width\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "# reading reference image from directory\n",
    "ref_image = cv2.imread(\"frame-1.png\")\n",
    "ref_image_face_width = face_data(ref_image)\n",
    "focal_length_found = focal_length(KNOWN_DISTANCE, KNOWN_WIDTH, ref_image_face_width)\n",
    "# print(focal_length_found)\n",
    "# cv2.imshow(\"ref_image\", ref_image)\n",
    "\n",
    "#########################################################################\n",
    "\n",
    "while True:\n",
    "    _, frame = cap.read()\n",
    "    face_width_in_frame = face_data(frame)\n",
    "    if face_width_in_frame != 0:\n",
    "        Distance = distance_finder(focal_length_found, KNOWN_WIDTH, face_width_in_frame)\n",
    "        cv2.putText(frame, f\"Distance = {round(Distance,2)} cm\",(50,50),fonts,1,white,2)\n",
    "    cv2.imshow(\"frame\", frame)\n",
    "\n",
    "    if cv2.waitKey(1)==27: break    # esc\n",
    "        \n",
    "#########################################################################\n",
    "        \n",
    "cap.release()\n",
    "cv2.destroyAllWindows()"
   ]
  }
 ],
 "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.8.5"
  }
 },
 "nbformat": 4,
 "nbformat_minor": 4
}