Removed debugging comments and simplified code

removed a pdb breakpoint and various commented prints. A loop was also spared in the computation of the state posteriors. Comment added to explain broadcasting.
Minor clarification in comment