mirror of
https://github.com/zhm-real/PathPlanning.git
synced 2026-08-29 16:40:46 +08:00
19 lines
1.5 KiB
Plaintext
19 lines
1.5 KiB
Plaintext
|
B
|
|||
|
|
°ò^± ã @ sJ d Z ddlZdd„ ZG dd„ dƒZedkrFeƒ Zeejej ƒZ
|
|||
|
|
e e
|
|||
|
|
ƒ dS )z
|
|||
|
|
@author: yue qi
|
|||
|
|
é Nc C sÒ ddddddgddddddgd ddd
|
|||
|
|
ddgd ddd ddgd
|
|||
|
|
dddddgddddddgddddddgg}g }x\|D ]T}t |¡}| |d | |d | |d | |d | |d | |d | f¡ qpW t |¡S )NgÍÌÌÌÌÌ@g gÍÌÌÌÌÌ @g333333@g @g @g333333"@gÍÌÌÌÌÌ#@g333333.@gÍÌÌÌÌÌ/@gš™™™™™¹?gÍÌÌÌÌÌì?gffffff@gš™™™™™@g333333(@gÍÌÌÌÌÌ)@gš™™™™2@gfffffæ2@r é é é é é )ÚnpÚarrayÚappend)Ú
|
|||
|
|
resolutionÚblockZ ObstaclesÚi© r
|
|||
|
|
úL/home/zhou/Program/path-planning-algorithms/Sampling-based Planning/env3D.pyÚ getblocks s
|
|||
|
|
|
|||
|
|
Jr c @ s e Zd Zd dd„Zdd „ Zd
|
|||
|
|
S ) Úenvr é r é r c C sT || _ t ||||||g¡| | _t|ƒ| _t dddg¡| _t dddg¡| _d S )Ng à?g @g @g 3@)r
|
|||
|
|
r r Úboundaryr ZblocksÚstartÚgoal)ÚselfÚxminZyminZzminÚxmaxZymaxZzmaxr
|
|||
|
|
r
|
|||
|
|
r
|
|||
|
|
r Ú__init__ s
|
|||
|
|
|
|||
|
|
z env.__init__c C s d S )Nr
|