Changed heavyweight AWT Panel to Swing JPanel in order to speed up HeadingPanel
Fixed calculation for new particle heading, when using compass to read robot heading