FIG. 4 shows an exemplary Planning and Decision Making function. 401: Raw data and processed data for three level planning. 402: Planning Module for macroscopic, mesoscopic, and microscopic level planning. 403: Decision Making Module for vehicle control instructions. 404 Macroscopic Level Planning. 405 Mesoscopic Level Planning. 406 Microscopic Level Planning. 407 Data Input for Macroscopic Level Planning: raw data and processed data for macroscopic level planning. 408 Data Input for Mesoscopic Level Planning: raw data and processed data for mesoscopic level planning. 409 Data Input for Microscopic Level Planning: raw data and processed data for microscopic level planning.
FIG. 5 shows an exemplary vehicle control flow component. 501: The planning and prediction module send the information to control method computation module. 502: Data fusion module receives the calculated results from different sensing devices. 503: Integrated data sent to the communication module of RSUs. 504: RSUs sends the control command to the OBUs.
FIG. 6 shows an exemplary flow chart of longitudinal control.
FIG. 7 shows an exemplary flow chart of latitudinal control.
FIG. 8 shows an exemplary flow chart of fail-safe control.