Monte Carlo -self localization algorithm

Monte Carlo -self localization algorithm preview image

1 collaborator

Default-person Joan Puig (Author)

Tags

car 

Tagged by Joan Puig almost 6 years ago

control theory 

Tagged by Joan Puig almost 6 years ago

google 

Tagged by Joan Puig almost 6 years ago

robotics 

Tagged by Joan Puig almost 6 years ago

self localiztion 

Tagged by Joan Puig almost 6 years ago

Visible to everyone | Changeable by the author
Model was written in NetLogo 5.0.5 • Viewed 324 times • Downloaded 16 times • Run 0 times
Download the 'Monte Carlo -self localization algorithm' modelDownload this modelEmbed this model

Do you have questions or comments about this model? Ask them here! (You'll first need to log in.)


Comments and Questions

Please start the discussion about this model! (You'll first need to log in.)

Click to Run Model

;Montecarlo-selflocalization algorithm

globals [TheColor myxcor myycor totalP sensor_color i1 i2 lastx lasty diffX diffY]

patches-own [p mycolor]
turtles-own []

to setup
  
clear-all

ask patches[set pcolor one-of[green yellow brown blue] set p 1 / count(patches) set totalP sum[p]of patches set mycolor pcolor]  

ask one-of patches

[
  sprout 1[
    
    set shape "circle"
    set color red
    set size 0.8
    
  ]

]
end 

to moveup
  
  ask turtles
  [
    set ycor ycor + 1
  ]
  ask patches
  [
    set p (move-right * [p] of patch-at 0 (- 1)) + (1 - move-right) * p
  ]
  sense
end 

to movedown
  
  ask turtles
  [
    set ycor ycor - 1
  ]
  ask patches
  [
    set p (move-right * [p] of patch-at 0 1) + (1 - move-right) * p
  ]
  sense
end 

to moveright
  
  ask turtles
  [
    set xcor xcor + 1
  ]
  ask patches
  [
    set p (move-right * [p] of patch-at (- 1) 0) + (1 - move-right) * p
  ]
  sense
end 

to moveleft
  
  ask turtles
  [
    set xcor xcor - 1
  ]
  ask patches
  [
    set p (move-right * [p] of patch-at 1 0) + (1 - move-right) * p
  ]
  sense
end 

to sense
  
  ;ask turtles with [color = white][set sensor_color [mycolor] of patch-ahead 0]  
  ask turtles [ask patch-here [set sensor_color mycolor]]
    
  ask patches
  [
    ifelse mycolor = sensor_color
    [
      set p p * sensor-right
    ][
      set p p * (1 -  sensor-right)
    ]
  ]
  set totalP sum[p]of patches
    
  ask patches
  [
    set p p / totalP
  ]
 
  ask patches
  [
    set pcolor scale-color green p 0 light
  ]
end 

to move
  
  
ask turtles
[
  set i1 one-of [0 1 -1]
  set i2 one-of [0 1 -1]
  
  set xcor xcor + i1
  set ycor ycor + i2
]
  
ask patches [set p (move-right * [p] of patch-at (- i1) (- i2) + (1 -  move-right) * p)]

  
  ask patches
  [
    set pcolor scale-color green p 0 light
  ]
end 

to go

  move
    
  sense 
end 

to go1
  if mouse-down?
  [
    sense1
    move1
    
  ]
end 

to s_color
  
  ask patches [set pcolor mycolor]
end 

to move1
  


ask patch mouse-xcor mouse-ycor [set diffX (lastx - mouse-xcor) set diffY (lasty - mouse-ycor)] 

ask patches [set p (move-right * [p] of patch-at (diffX) (diffY) + (1 -  move-right) * p)]

ask patch mouse-xcor mouse-ycor [set lastx mouse-xcor set lasty mouse-ycor]
end 

to sense1
  
  ;ask turtles with [color = white][set sensor_color [mycolor] of patch-ahead 0]  
  ask patch mouse-xcor mouse-ycor [set sensor_color mycolor]
    
  ask patches
  [
    ifelse mycolor = sensor_color
    [
      set p p * sensor-right
    ][
      set p p * (1 -  sensor-right)
    ]
  ]
  set totalP sum[p]of patches
    
  ask patches
  [
    set p p / totalP
  ]
 
  ask patches
  [
    set pcolor scale-color green p 0 light
  ]
end 

  
  
  
  
  
  
  
  
  
  
  
  
  
  
  
  
  
  

There is only one version of this model, created almost 6 years ago by Joan Puig.

Attached files

File Type Description Last updated
Monte Carlo -self localization algorithm.png preview Preview for 'Monte Carlo -self localization algorithm' almost 6 years ago, by Joan Puig Download

This model does not have any ancestors.

This model does not have any descendants.