Extend 2d density plotter to support more state types

[sdhiscocks]

Reference #458, it would be good for the density plotter to also support plotting Gaussian mixtures (like used in PHD filter) and other types of state.