B
    ®Çd–  ã               @   sœ   d dl mZ d dlmZ d dlZd dlmZ dZdZdZdZ	e 
ej¡ e eej¡ e eej¡ e eej¡ e e	ej¡ dd	„ Zd
d„ Zdd„ ZdS )é    N)Úturn)Úsleepé   é   é   é   c              C   s„   t  td¡ tdƒ t  td¡ t ¡ } t ¡ }xt  t¡dkrJt ¡ } q2W xt  t¡dkrft ¡ }qNW ||  }d}|| d }|S )NTgñhãˆµøä>Fr   é   iü…  é   )ÚGPIOÚoutputÚtrig_pinr   ÚtimeÚinputÚecho_pin)Úpulse_startÚ	pulse_endÚpulse_durationÚsound_vÚdistance© r   ú/home/pi/P21/ultdis.pyÚ	distance1   s    r   c              C   s„   t  td¡ tdƒ t  td¡ t ¡ } t ¡ }xt  t¡dkrJt ¡ } q2W xt  t¡dkrft ¡ }qNW ||  }d}|| d }|S )NTgñhãˆµøä>Fr   r   iü…  r	   )r
   r   Ú	trig_pin2r   r   r   Ú	echo_pin2)r   r   r   r   Ú	distance2r   r   r   r       s    r   c              C   s~   d} t ƒ }t|dƒ}tƒ }t|dƒ}|| kr8|| kr8d}|| krL|| krLd}|| k r`|| kr`d}|| k rt|| k rtd}|||fS )Nr   r   é   é   r   )r   Úroundr   )ÚDÚdis1Zdis2ÚDRr   r   r   Úultsound0   s     
 
    r!   )ÚRPi.GPIOr
   Úmotormr   r   r   r   r   r   r   ÚsetmodeÚBCMÚsetupÚOUTÚINr   r   r!   r   r   r   r   Ú<module>   s   