Added cases for mapping leg forces and balancing

Significant updates to the mechanical layer to correct errors.