A system for vehicle trajectory planning. The system may include a polarized camera system configured to generate polarized images of a roadway to be driven over with a vehicle, a prior controller configured to generate a prior for the roadway based at least in part on the polarized images, and a driving assistance system configured to provide a driving assistance according to the prior.