How about designing roads for people. All the problems you mention should be solved even if we don't have self-driving cars of any kind.: start designing road

How about designing roads for people. All the problems you mention should be solved even if we don't have self-driving cars of any kind.: start designing roads specifically for ease of use. design lanes that are extremely easy to see. Traffic lights that are easy to parse. Street signs standardized and easily readable.