Fixed a bug in center of mass.
Enable better bridge detection angle for open sides.
Got the first bridge unit test running and passing.