Improving Safety Mobility and Cybersecurity with Infrastructure-Assisted Cooperative Driving