Added additional matlab plotting tools.
Merge branch 'pladypos_impl' of https://github.com/labust/labust-ros-pkg into pladypos_impl