added new geometry support to fallingBrickLCP.m