added pf functionality, prints out initpose,truth and all particles. feel free to comment out