implement rqt 3d plot