started adding tests. It is getting to confusing with all these different functionalities. Tried to make DFS inward operation independent, needs testing. Introduced balance<force> instead of project<wrench> to do forward force computation. Now project<force> does a real force to torque projection