xe tự hành tránh vật cản

Báo cáo thực tập tốt nghiệp

1


Các Robot         








Chúng em xin cô 



Chúng em 
            

Nhóm sinh viên
Lê Trung Kiên







Báo cáo thực tập tốt nghiệp

2


L 1
M 2
D 4
C1 G 5
1.1  5
1.2  5
C2 T 6
 6
 8
 9
C3 M  10
 10
 11
 13
C4 CKINECT 14
 14
 14
 23
C5 M 27
 27
-Kit MSP430FR5739 31
5.4 CC3000 36
 40
Báo cáo thực tập tốt nghiệp

3

K 41
T 42













Báo cáo thực tập tốt nghiệp

4


Hình 2-1 Asterisk - 6
Hình 2-2 Curiosity- 7
Hình 2-7
Hình 2-4 
Hình 10
Hình 4-15
Hình 4-16
Hình 4-18
Hình 4-.18

Hình 4- 20

Hình 4-24
Hình 4-
Hình 4-27

 29

31
34
35
Hình  38
-SL

Hình 5.10 MSP430FR5739 board+CC3000 TiWi-SL.40


Báo cáo thực tập tốt nghiệp

5

 
1.1 

            








      

.
1.2 





u



Báo cáo thực tập tốt nghiệp

6












Hình 2-1 Asterisk - 
Báo cáo thực tập tốt nghiệp

7


Hình 2-2 Curiosity- 
L


Hình 2-
Báo cáo thực tập tốt nghiệp

8






-               


- 




tính toán và 









i 


Báo cáo thực tập tốt nghiệp

9


-4)
 
 .
Các thành p


Sau khi






Hình 2-

Báo cáo thực tập tốt nghiệp

10

 
HÀNH






- 

- 
mm
Cx y

- 
'O xy



t
V
,
p

V

(
0
x
,
0
y

Báo cáo thực tập tốt nghiệp

11

os( ) 0
sin( ) 0
w
01
xc
v
y



   

   


   


   
   
(3.1)

  Và có:
22
w 2 2
t
p
rr
V
v
V
rr
DD














(3.2)

.
tt
Vr


(3.3)
.
pp
Vr


(3.4)
.

robot:
- w=0,
v

0) :V
t
=V
p

- 0,
v
=0 ):V
t
= -V
p



3.1) và (3.2

os( ) os( )
22
rr
sin( ) sin( )
22
2r 2r
DD
t
p
rr
cc
x
V
y
V























(3.5)



        , theo Euler-
L:
Báo cáo thực tập tốt nghiệp

12

( ). ( , ). ( ) ( ). ( ).
T
M q q C q q q G q B q J q

   
(3.6)

-
()Mq


-
( , )C q q

-
()Gq

-
()Bq

-


-
()Jq

-





( , ) 0C q q 
,
( ) 0Gq 
,
( ). 0J q q 
(3.7)


sau

( , , )
T
q x y


:
1
2
0 0 os( ) os( ) sin( )
1
0 0 sin( ) sin( ) os( )
0 0 D 0
m x c c
m y c
r
ID
  

   


       

       
  

       

       


       
(3.8)


12
1
()
l
R
  

;
12
1
()
a
R
  




H:
os( )+ sin( )
m
l
xc
m






os( )- sin( )
m
l
yc
m




(3.9)

a
I




Báo cáo thực tập tốt nghiệp

13

 
.sin( ) . os( )x v vc
  
  

. os( ) .sin( )y v c v
  

(3.10)
w




So sán), (3.10):
l
v
m


(3.11)

a
w =
I




- 
c

robot.
- 
d


robot

- 
 

 

- 

trên xe robot.



Báo cáo thực tập tốt nghiệp

14

NECT










Hình 4-



2010 .
Báo cáo thực tập tốt nghiệp

15





 skeleton tracking).


 





Hình 4-
Bên trong Kine

Camera RGB


Báo cáo thực tập tốt nghiệp

16




DãyMicrophone





 
.



 .
     






 


Báo cáo thực tập tốt nghiệp

17

Hình 4-


Hình 4-
Báo cáo thực tập tốt nghiệp

18
















 



 




 Kinect SDK 



Báo cáo thực tập tốt nghiệp

19

 

Kinect.-

Hình 4-g OpenNI


  
khác nhau.
- Module PCL_Common

- Module Features

- Module PCL_filters 
- Module Geometry: 

- Module PCL_IO

- Module PCL_Kdtree:          

Báo cáo thực tập tốt nghiệp

20

- Module PCL_Keypoint            

trong po

- PCL_Octree: 
   ho phép phân vùng không gian, downsampling


- Module registrantion (PCL_registration):       
             


- Module PCL_sample_consensus:     




- PCL_Search        

- Module PCL_Segmentation
các nhóm riên


- Module PCL_surface


- Module PCL_visualization

.
Báo cáo thực tập tốt nghiệp

21



PointCloud.
PointCloud 
         

o Có 

o 



Vd: cloud.width=640;// Tao ra 640 diem tren mot dong
 


Báo cáo thực tập tốt nghiệp

22

Vd:
cloud.width = 640; // Khai bao mot anh co cau truc, gom 640 dong va 480 cot
cloud.height = 480; // tong so diem anh la 640*480=307200.

 Points (std::vector<PointT>)



- pcl::PointXYZ 

- pcl::PointXYZRGB 

- pcl::PointXYZRGBA


pcl::PointCloud<pcl::PointXYZ> cloud;
std::vector<pcl::PointXYZ> data = cloud.points;
 Is_dense(bool)

False.
Ngoài 
ng trong





Báo cáo thực tập tốt nghiệp

23


          nect.

Hình 4-






:
 



#include <pcl/io/openni_grabber.h>
 

pcl::Grabber* interface =new pcl::OpenNIGrabber();


boost::function<void(const pcl::PointCloud<pcl::PointXYZRGBA>::ConstPtr&)> f

boost::bind (&SimpleOpenNIProcessor::cloud_cb_,this, _1);
// cloud_cb_ l{ h{m dùng để xử lý dữ liệu nhận về, ở ví dụ n{y cloub_cb_ để
hiển thị //ra m{n hình.

 

Báo cáo thực tập tốt nghiệp

24

D liu thu v làđim nh mu 3D pointXYZRGB:
void (const boost::shared_ptr<const pcl::pointCloud <pcl::pointXYZRGB>>&)
- D liu thu v làđim nh không mu 3D pointXYZ:

void (const boost::shared_ptr<const pcl::pointCloud <pcl::pointXYZ>>&)
- D liu thu v lành RGB t camera :
void (const boost::shared_ptr< openNI_wrapper::Image>&)
- D liu thu v là bn đđ sâu:
void (const boost::shared_ptr< openNI_wrapper::DepthImage>&)



interface->registerCallback(f);

interface->start();

…
interface->stop();
4.3.2 Voxel grid:

 


- pcl::VoxelGrid<PointType> grid_;         
 
- grid_.setLeafSize (leaf_size_x, leaf_size_y, leaf_size_z);     
.
- grid_.setFilterFieldName (field_name); : 
Z
- grid_.setFilterLimits (min_v, max_v);

double min_v = 0.5, max_v = 1.5;
std::string field_name ("z");
double leaf_x = 0.02, leaf_y = 0.02, leaf_z = 0.02;

Báo cáo thực tập tốt nghiệp

25



Hình 4-
4.3.3 Plannar segmentation

             
Consensus).
4.3.4 Euclidean cluster extraction
Euclidean cluster extraction 
         


 

                  
Clusters). Quá 
Extraction.  
 

 