U
    pÕ®_  ã                   @   sR   d dl Z d dlZd dlZd dlZd dlZd dlZd dlZd dlZG dd„ dƒZdS )é    Nc                   @   sÔ   e Zd ZdZd7dd„Zdd„ Zdd	„ Zd
d„ Zdd„ Zdd„ Z	dd„ Z
dd„ Zdd„ Zd8dd„Zdd„ Zd9dd„Zdd„ Zd d!„ Zd:d#d$„Zd;d%d&„Zd'd(„ Zd)d*„ Zd+d,„ Zd-d.„ Zd/d0„ Zd<d3d4„Zd5d6„ ZdS )=ÚOpenOcdúÚ	localhosté\  c                 C   s.   || _ || _d| _d| _t tjtj¡| _d S )Ni   Z
python_tcl)Ú_tcl_rpc_hostÚ_tcl_rpc_portÚ_buffer_sizeÚ_tcl_variableÚsocketÚAF_INETÚSOCK_STREAMÚ_socket)ÚselfÚhostÚport© r   ú7F:\github\m365-Electric-Scooter-4-Pro-stlink\openocd.pyÚ__init__   s
    zOpenOcd.__init__c                 C   s   |   ¡  | S ©N)Úconnect©r   r   r   r   Ú	__enter__$   s    zOpenOcd.__enter__c                 C   s   z|  ¡  W 5 |   ¡  X d S r   )ÚcloseÚexit)r   ÚtypeÚvalueÚ	tracebackr   r   r   Ú__exit__(   s    zOpenOcd.__exit__c                 C   s   | j  | j| jf¡ d S r   )r   r   r   r   r   r   r   r   r   .   s    zOpenOcd.connectc                 C   s   | j  ¡  d S r   )r   r   r   r   r   r   r   1   s    zOpenOcd.closec                 C   s$   |t j  d¡}| j |¡ |  ¡ S )Núutf-8)r   ÚCOMMAND_TOKENÚencoder   ÚsendÚ_recv)r   ÚcmdÚdatar   r   r   r!   4   s    zOpenOcd.sendc                 C   sP   t ƒ }| j | j¡}||7 }t tjdd�|krq2q| d¡ ¡ }|d d… }|S )Nr   )Úencodingéÿÿÿÿ)Úbytesr   Úrecvr   r   r   ÚdecodeÚstrip)r   r$   Ztmpr   r   r   r"   :   s    zOpenOcd._recvc                 C   s   |   d¡ d S )Nr   ©r!   r   r   r   r   r   I   s    zOpenOcd.exitc                 C   s   |   d¡ d S )NÚstepr+   r   r   r   r   r,   L   s    zOpenOcd.stepNc                 C   s&   |d kr|   d¡ n|   d| ¡ d S )NÚresumezresume 0x%xr+   ©r   Úaddressr   r   r   r-   O   s    zOpenOcd.resumec                 C   s   |   d¡ d S )NÚhaltr+   r   r   r   r   r0   U   s    zOpenOcd.haltéˆ  c                 C   s   |   d| ¡ d S )Nzwait_halt %ur+   )r   Útimeoutr   r   r   Ú	wait_haltX   s    zOpenOcd.wait_haltc                 C   sB   t t t¡j ¡ ƒ}d| d | d|  }|  | dd¡¡ d S )Núprogram ú\z verify 0x%xú/©ÚstrÚpathlibÚPathÚ__file__ÚparentÚabsoluter!   Úreplace)r   r/   ÚbinaryÚpathÚcommandr   r   r   Úwrite_binary[   s    zOpenOcd.write_binaryc                 C   s>   t t t¡j ¡ ƒ}d| d | d }|  | dd¡¡ d S )Nr4   r5   z verifyr6   r7   )r   Zhex_filer@   rA   r   r   r   Ú	write_hex`   s    zOpenOcd.write_hexé    c                 C   s\   d  dd„ t|ƒD ƒ¡}|  d| j ¡ |  d| j|f ¡ |  d| j||t|ƒf ¡ d S )Nú c                 S   s   g | ]\}}d ||f ‘qS )z%d 0x%xr   )Ú.0ÚiÚvr   r   r   Ú
<listcomp>f   s     z(OpenOcd.write_memory.<locals>.<listcomp>úarray unset %szarray set %s { %s }zarray2mem %s 0x%x %s %d)ÚjoinÚ	enumerater!   r	   Úlen)r   r/   r$   Úword_lengthZarrayr   r   r   Úwrite_memorye   s    
  ÿzOpenOcd.write_memoryc           	         sª   |   d| j ¡ |   d| j|||f ¡ |   d| j ¡ d¡‰ ‡ fdd„ttˆ ƒd ƒD ƒ}‡ fdd„ttˆ ƒd ƒD ƒ}d	gt|ƒ }t|ƒD ]\}}|| ||< q�|S )
NrJ   zmem2array %s %d 0x%x %dz
return $%srE   c                    s   g | ]}t ˆ d |  ƒ‘qS )é   ©Úint©rF   rG   ©Úrawr   r   rI   x   s     z'OpenOcd.read_memory.<locals>.<listcomp>rP   c                    s    g | ]}t ˆ d | d  ƒ‘qS )rP   é   rQ   rS   rT   r   r   rI   y   s     r   )r!   r	   ÚsplitÚrangerM   rL   )	r   r/   ÚcountrN   ÚorderÚvaluesÚresultrG   Úposr   rT   r   Úread_memoryo   s    
  ÿzOpenOcd.read_memoryc                 C   sV   t t|ƒtƒr$|  d| ¡ d¡}n|  d| ¡ d¡}t|ƒdk rHd S t|d dƒS )Nz
ocd_reg %uz: z
ocd_reg %srP   rV   é   )Ú
issubclassr   rR   r!   rW   rM   )r   ÚregisterrU   r   r   r   Úread_register‚   s    zOpenOcd.read_registerc                 C   s4   t ƒ }|D ]$}|  |¡}|d kr& d S |||< q
|S r   )Údictrb   )r   Ú	registersr\   ra   r   r   r   r   Úread_registersŒ   s    

zOpenOcd.read_registersc                 C   s8   d gt |ƒ }|  |¡}|D ]}|| || |¡< q|S r   )rM   re   Úindex)r   rd   Zregister_listr\   Úregr   r   r   Úread_register_list™   s
    
zOpenOcd.read_register_listc                 C   s8   t t|ƒtƒr"|  d||f ¡ n|  d||f ¡ d S )Nzreg %u 0x%xzreg %s 0x%x)r`   r   rR   r!   )r   ra   r   r   r   r   Úwrite_register£   s    zOpenOcd.write_registerc                 C   s   |D ]}|   ||| ¡ qd S r   )ri   )r   rd   rg   r   r   r   Úwrite_registers©   s    zOpenOcd.write_registersrP   Tc                 C   s.   |r|   d||f ¡ n|   d||f ¡ d S )Nzbp 0x%x %u hwz
bp 0x%x %ur+   )r   r/   ÚlengthZhardwarer   r   r   Úset_breakpoint­   s    zOpenOcd.set_breakpointc                 C   s   |   d| ¡ d S )Nzrbp 0x%xr+   r.   r   r   r   Úremove_breakpoint³   s    zOpenOcd.remove_breakpoint)r   r   )N)r1   )rD   )rD   )rP   T)Ú__name__Ú
__module__Ú__qualname__r   r   r   r   r   r   r!   r"   r   r,   r-   r0   r3   rB   rC   rO   r^   rb   re   rh   ri   rj   rl   rm   r   r   r   r   r      s0   
	







r   )	ÚsysÚmathÚargparseÚstructÚenumÚosr9   r
   r   r   r   r   r   Ú<module>   s   