Add function to plot bounding box in 3D

Implements #130.