An enhanced motion planning approach by integrating driving heterogeneity and long-term trajectory prediction for automated driving systems