
    wfM                     *   d dl m Z  d dlZ G d d          Zedk    ru ed            ed            ed            ed	            e            Z	 	  ed          D ]Ze                    ed           n# e	$ r  ed           Y dS w xY w>dS )    )PCA9685Nc                        e Zd Zd Zd Zd ZdS )Servoc                     d| _         d| _        t          dd          | _        | j                            d           d S )N      @   T)addressdebug2   )angleMinangleMaxr   pwm
setPWMFreq)selfs    6/home/digit/Desktop/robocat/Code/Server/fabio/Servo.py__init__zServo.__init__   s@    4t444B    c                 *    ||z
  ||z
  z  ||z
  z  |z   S )N )r   valuefromLowfromHightoLowtoHighs         r   mapz	Servo.map   s$    uuW}-'1ABUJJr   c                     || j         k     r| j         }n|| j        k    r| j        }|                     |dddd          }| j                            |dt          |                     d S )Nr      f   i   )r   r   r   r   setPWMint)r   channelangledates       r   setServoAnglezServo.setServoAngle   si    4=  MEEDM!!-EXXeAc#c**CII.....r   N)__name__
__module____qualname__r   r   r%   r   r   r   r   r      sD             K K K/ / / / /r   r   __main__u   Now servos will rotate to 90°.u<   If they have already been at 90°, nothing will be observed.z;Please keep the program running when installing the servos.z4After that, you can press ctrl-C to end the program.T   Z   z
End of program)
r   timer   r&   printSrangeir%   KeyboardInterruptr   r   r   <module>r2      s!         / / / / / / / /& z	E
+,,,	E
HIII	E
GHHH	E
@AAAeggA	U2YY & &"%%%%&  	 	 	E%&&&EE		 s   $A; ;BB