Hierarchical Extraction, Planning and Behavior Tree Process Control Based on Historical Trajectory | IEEE Conference Publication | IEEE Xplore