B
    ®ÇdÝ  ã               @   sŒ   d dl mZ d dlZd dlmZ d dlZd dlZd dlT d dlm	Z	 d dl
mZ d dlmZ dZdZe eej¡ e eej¡ d	d
„ ZdS )é    N)Úsleep)Ú*)Úturn)Úlocate)ÚUturnBKé   é   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 }t|dƒ}|S )NTgñhãˆµøä>Fr   é   iü…  é   )ÚGPIOÚoutputÚtrig_pinr   ÚtimeÚinputÚecho_pinÚround)Úpulse_startÚ	pulse_endÚpulse_durationÚsound_vÚdistanceÚdis1© r   ú/home/pi/P21/DIST.pyÚ	distance1   s    
r   )ÚRPi.GPIOr   r   r   Úcv2ÚnumpyÚnpÚPARAMÚmotormr   ÚLOCATE1r   r   r   r   ÚsetupÚOUTÚINr   r   r   r   r   Ú<module>   s   