Hierarchical Planning and Policy Shaping Shared Autonomy for Articulated Robots