Add in beginings of particle filter code