added hubo joints and still workign on single joint example