Movement simulations of the dual-arm tracking optimized path by the 3D A* heuristic algorithm of humanoid robot with whole modeling before and after motion optimization based on 2-norm in 3D