guard reference to 'mplot3d' in function that can be used without 3D

If 'mplot3d' is not available then plotting 2D systems fails because 'plot' calls 'set_colors', which references 'mplot3d'.