mirror of
https://github.com/zhm-real/PathPlanning.git
synced 2026-08-30 09:00:47 +08:00
16 lines
2.0 KiB
Plaintext
16 lines
2.0 KiB
Plaintext
|
B
|
|||
|
|
¹ûë^µ ã @ s4 d Z ddlmZ d\ZZdd„ Zdd„ Zdd „ ZdS )
|
|||
|
|
z
|
|||
|
|
@author: huiming zhou
|
|||
|
|
é N)é3 é c C s g } x t tƒD ]}| |df¡ qW x"t tƒD ]}| |td f¡ q.W x t tƒD ]}| d|f¡ qRW x"t tƒD ]}| td |f¡ qrW x t ddƒD ]}| |df¡ q˜W x t dƒD ]}| d|f¡ q¸W x t ddƒD ]}| d|f¡ qÚW x t dƒD ]}| d |f¡ qúW | S )
|
|||
|
|
zH
|
|||
|
|
Initialize obstacles' positions
|
|||
|
|
|
|||
|
|
:return: map of obstacles
|
|||
|
|
r é é
|
|||
|
|
é é é é é é( )ÚrangeÚx_rangeÚappendÚy_range)ZobsÚi© r úVC:\Users\Huiming Zhou\Desktop\path planning algorithms\Stochastic Shortest Path\env.pyÚobs_map s$ r c C s* g } x t ddƒD ]}| |df¡ qW | S )Né é" é
|
|||
|
|
)r r )Zloser r r r Úlose_map* s r c sâ ‡fdd„t tˆƒƒD ƒ}‡fdd„t tˆƒƒD ƒ}‡ fdd„t tˆ ƒƒD ƒ}‡ fdd„t tˆ ƒƒD ƒ}t | d | d d¡ t |d |d d ¡ t ||d
|
|||
|
|
¡ tj||d d d
|
|||
|
|
� tj|d d� t d¡ t d¡ t ¡ d S )Nc s g | ]}ˆ | d ‘qS )r r )Ú.0r )r r r ú
|
|||
|
|
<listcomp>2 s z show_map.<locals>.<listcomp>c s g | ]}ˆ | d ‘qS )r r )r r )r r r r 3 s c s g | ]}ˆ | d ‘qS )r r )r r )r r r r 5 s c s g | ]}ˆ | d ‘qS )r r )r r )r r r r 6 s r r ZbsZgsZskÚsz#A52A2A)ZmarkerZcolor)ZfontdictTZequal)r ÚlenÚpltZplotÚtitleZgridZaxisZshow) ZxIZxGr r ÚnameZobs_xZobs_yZlose_xZlose_yr )r r r Úshow_map1 s
|
|||
|
|
|