B
    e'                 @   sj  d dl Zd dlZd dlmZ d dlmZ dZdZdZ	e
ee	 Ze
ee	 Zddd	gZeed  d
 ddgZeed  d
 ddgZejeddZejeddZed ddgZed
ddgZedede dd Zedkrfd dlmZ ed ed Zeejd eejd ed e \ZZee\ZZZ Z!Z"edeee! e#de" e$d  dS )    N)turn)sleepi  i              
   F   2      uint8)dtypezlower=z upper=c          	   C   s$  t | }t|ttf}|t}t|tj	}td }ttd }g }dddg}g }	xt
tD ]}
|||
df dk r|	|
 td |||
df   k rtd k rbn qbtd |||
df   k rtd k rbn qb||
 x*t
dD ]}||  |||
|f 7  < qW qbW t|	td kr0ddd||fS t|}|dkrjx&t
dD ]}t|| | ||< qLW |dkrtt |}t||t df|t |t fdd d	|  krdkrn nd}nBd|  k rd
k rn nd}n d|  krd	k rn nd}nd}d}|||||fS )N      r   r	      r   d   )r   r   r   <         )npcopycv2resizeLX2LY2astypeintcvtColorCOLOR_BGR2HSVrangeappendlowerupperlenmedianlineF)imgimg1img2Zimg3hsvYZXMZredshZblackxtlredmidldr r4   /home/pi/PW24/RED_BOTH.pyRED_BOTH   sD    

   
  
T
 " 
 
&    r6   __main__zbottclr as a mainr   zdr,lred,sh=r*   )%numpyr   r   motormr   timer   LxLyr(   r   r   r   ZPINarrayr#   r$   low2upp2printr6   __name__VideoCapturecapsetCAP_PROP_FRAME_WIDTHCAP_PROP_FRAME_HEIGHTreadretr)   r3   r1   r2   r.   r*   imshowwaitKeyr4   r4   r4   r5   <module>   s:       
 

