Added the total excavator test

The total excavator is built with planar constraints.