Imported from https://github.com/shichaoy/matlab_cuboid_detect