Wrote more notes, fixed some small bugs in particle filter