Tensegrity Full Body Control: An Inequality Constrained Optimization Approach