Start working on particle filter

it seems to be 'working'
it needs to learn a little faster to keep pace...