Six degree of freedom joint power in stair climbing