Implicit Latent Variable Model For Scene-Consistent Motion Forecasting
Implicit Latent Variable Model For Scene-Consistent Motion Forecasting
1 Introduction
Self driving vehicles (SDV) have the potential to make a broad impact in our
society, providing a safer and more efficient solution to transportation. A critical
component for autonomous driving is the ability to perceive the world and fore-
cast all possible future instantiations of the scene. 3D perception algorithms have
improved incredibly fast in recent years [34, 38, 48, 60, 62, 65], yielding very ac-
curate object detections surrounding the SDV. However, producing multi-modal
motion forecasts that precisely capture multiple plausible futures consistently
for all actors in the scene remains a very open problem.
The complexity is immense: the future is inherently uncertain as actor be-
haviors are influenced not only by their own individual goals and intentions but
also by the other actors’ actions. For instance, an actor at an intersection may
choose to turn right or go straight due to its own destination, and yield or go if
the behavior of a nearby traffic participant is aggressive or conservative. More-
over, unobserved traffic rules such as the future traffic light states heavily affect
the traffic (see Fig.1). It is clear that all these aspects cannot be directly ob-
served and require complex reasoning about the scene as a whole, including its
geometry, topology and the interaction between multiple agents.
?
Denotes equal contribution
2 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
(a) Sample 1: protected left turn (b) Sample 2: horizontal traffic flow
Fig. 1: Two scene-consistent future trajectory samples from our model.
Ground truth trajectories are shown as white polylines.
trajectories as a deterministic mapping from the inputs and scene latent sam-
ples, making the latent variables capture all the stochasticity in our generative
process. Furthermore, this allows us to perform efficient inference via parallel
sampling.
We show that our ILVM significantly outperforms the motion forecasting
state-of-the-art in ATG4D [62] and nuScenes [8]. We observe that our ILVM
is able to generate scene-consistent samples (see Fig. 1) while producing less
entropic joint distributions that also better cover the ground-truth. Moreover,
when using our scene-consistent motion forecasts, a state-of-the-art motion plan-
ner [54] can plan safer and more comfortable trajectories.
2 Related Work
decisions, and (ii) modeling the marginal distribution per actor cannot provide
trajectory samples that are consistent across actors.
Another research stream [1,13,21,31,35,42,50,51,57] has focused on the prob-
lem of multi-agent trajectory prediction from perfect perception, i.e., assuming
that the ground-truth past trajectory of all actors’ is given. Unfortunately, this
is not realistic in self-driving vehicles, which rely on imperfect perception with
noise that translates into failures such as false positive and false negative de-
tections and id switches in tracking. Nonetheless, these methods have proposed
output parameterizations that can predict multi-modal distributions over future
trajectories, which are applicable to our end-to-end perception and prediction
setting.
Various factorizations of the joint distribution over N actors’ trajectories
p(Y |X) = p(y1 , · · · , yN |x1 , · · · , xN ) with different levels of independence as-
sumptions have been proposed to sidestep the intractability of p(Y |X). The
simplest approximation
Q Q is to assume independent futures across actors and time
steps p(Y |X) = n t p(ynt |X), as shown in Fig. 2a. Some approaches directly
regress the parameters of a mixture of Gaussians over time [11, 12, 39], which
provides efficient sampling but can suffer from low expressivity and unstable
optimization. Non-parametric approaches [26,27,47,52] have also been proposed
to characterize the multi-modality of one actor’s individual behavior. These ap-
proaches either score trajectory samples from a finite set [47, 64] with limited
coverage or predict an occupancy grid at different future horizons [26, 27, 52],
which is very memory consuming. [50] proposed to learn a one-step policy that
predicts the next waypoint based on the previous history, avoiding the time in-
dependence assumption. Variational methods [20, 36] inspired by [29, 56] have
also been proposed to learn an actor independent latent space to capture unob-
served actor dynamics such as goals. Unfortunately, none of these methods can
accurately characterize the joint distribution in interactive situations, since the
generative process is independent per actor.
An alternative approach to better characterize the behavior of multiple ac-
tors jointly is autoregressive generation with social mechanisms [1, 51], which
predict the distribution over the next trajectory waypoint of each actor condi-
tioned on the previous states of all actors p(Y |X) = n t p ynt |Y 0:t−1 , X .
Q Q
This approach has been enhanced by introducing latent variables [25, 31, 57], as
in Fig. 2b. In particular, [31] introduces discrete latent variables to model pair-
wise relationships in an interaction graph, while in [25,57] they capture per-actor
high-level actions. Autoregressive approaches, however, suffer from compound-
ing errors [33, 46, 53]. During training, the model is fed the ground-truth Y 0:t−1 ,
while during inference, the model must rely on approximate samples from the
learned distribution. While scheduled sampling [5] has been proposed to miti-
gate this issue, the objective function underlying this method is improper [24]
and pushes the conditional distributions p(ynt |Y 0:t−1 ) to model the marginal dis-
tributions p(ynt ) instead. Moreover, these methods require sequential sampling,
which is not amenable to real-time applications such as self-driving.
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 5
Voxelized LiDAR
Backbone Network RRoI pooled
Global features and object detections Actor context
and Object Detector features
x1
x2 X
Raster Map
x3
Fig. 3: Actor Feature Extraction. Given LiDAR and maps, our backbone
CNN detects the actors in the scene, and individual feature vectors per actor
are extracted via RRoI Align [41], followed by a CNN with spatial pooling.
partition the scene latent as Z = z1 , z2 , · · · , zN , obtaining a distributed rep-
resentation where zn is anchored to actor n in an interaction graph with traffic
participants as nodes. The distributed representation has the benefit of naturally
scaling the capacity of the latent space as the number of actors grow. Further-
more, the anchoring gives the model an inductive bias that eases the learning
of a scene latent space. Intuitively, each latent zn encodes unobserved dynam-
ics most relevant to actor n, including interactions with neighboring actors and
traffic rules that apply in its locality. We represent
each
1zn as a diagonal multi-
variate gaussian zn ∼ N µ1n (X), · · · , µD n (X) , diag σn (X), · · · , σn
D
(X) , as
is common with variational models [29, 56]. We emphasize that although factor-
ized, the latent space is not marginally independent across actors since each zn
is conditioned on all x1 , · · · , xN as shown in the graphical model in Fig. 2c.
Since integration over Z is intractable, we exploit amortized variational infer-
ence [29, 56]. By introducing an encoder distribution Q(Z|X, Y ) to approximate
the true posterior P (Z|X, Y ), the learning problem can be reformulated as a
maximization of the Evidence Lower BOund (ELBO). Please visit the supple-
mentary for a more thorough description of variational inference.
Fig. 4: Our Implicit Latent Variable Model encodes the scene into a latent
space, from which it can efficiently sample multiple future realizations in parallel,
each with socially consistent trajectories.
providing the local context for all actors, as proposed by [9]. As mentioned at the
beginning of Section 3, this will be the input to our motion forecasting module.
This contrasts with previous approaches (e.g., [11, 13, 51, 57]) that assume past
trajectories for each actor are given. We refer the reader to the supplementary
material for more details about our perception module, including the backbone
architecture and detection parameterization.
Scene Interaction Module (SIM): This is a core building block of our en-
coder, prior, and decoder networks, as shown in Fig. 4. Once we have extracted
individual actor features, we can frame the scene as a fully-connected inter-
action graph where each traffic participant is a node. Inspired by [9], we use
a spatially-aware graph neural network to model multi-agent dynamics, as de-
scribed in Alg. 1. Our SIM performs a single round of message passing to update
the nodes’ representation, taking into account spatiotemporal relationships.
Encoder: To approximate the true posterior latent distribution P (Z|X, Y ), we
introduce an approximate posterior qφ (Z|X, Y ), implemented by our SIM and
parameterized by φ. This network is also commonly known as recognition net-
work, since it receives the target output variable Y as an input, and thus it can
recognize the scene dynamics that are unobserved by the prior pγ (Z|X). Note
that the encoder can only be used during training, since it requires access to the
ground-truth future trajectories. We initialize the node representations as hn =
MLP(xn ⊕ GRU(yn )), where ⊕ denotes concatenation along the feature dimen-
sion. After running one round of message passing, the scene interaction module
predicts the distribution over scene latent variables Z = z1 , z2 , · · · , zN . We
stress that despite anchoring each partition of the scene latent to an actor, each
individual zn contains information about the full scene, since each final node
representation is dependent on the whole input X because of the message prop-
agation in the fully-connected interaction graph.
Prior: The prior network pγ (Z|X) is responsible for approximating the prior
distribution of the scene latent variable Z at inference time. Similar to the
encoder, we model the scene-level latent space with our SIM, where the only
difference is that the initial node representations in the graph propagation are
hn = MLP(xn ), since yn is not available at inference time.
8 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
Deterministic Decoder: Recall that our scene latent has been partitioned into
a distributed representation Z = z1 , z2 , · · · , zN . To leverage actor features
and distributed latents from the whole scene, we parameterize the decoder with
another SIM. We can then predict the s-th realization of the future at a scene
level via message passing, where each actor trajectory yns takes into account a
sample from all the partitions of the scene latent Z s = z1s , · · · , zns as well as all
actors’ features X, enabling reasoning about multi-agent interactions such as car
following, yielding, etc. More precisely, given each actor context xn , we initialize
its node representation for the decoder graph propagation as hsn = MLP(xn ⊕
0
zns ). After a round of message passing in our SIM, hns contains an updated
representation of actor n that takes into account the underlying dynamics of
the whole scene summarized in Z s . Finally, the s-th trajectory sample for actor
0
n is deterministically decoded yns = MLP(hns ) by the SIM output function,
without additional sampling steps. The trajectory-level scene sample is simply
the collection of all actor trajectories Y s = y1s , . . . , yN
s
. We can generate S
possible futures for all actors in the scene in parallel by batching S scene latent
samples.
In this fashion, our model implicitly characterizes the joint distribution over
actors’ trajectories, achieving superior scene-level consistency. In the experi-
ments section we ablate the design choices in the encoder, prior and decoder,
and show that although all of them are important, the deterministic decoder is
the key contribution towards socially-consistent trajectories.
3.3 Learning
Our perception and prediction model can be trained end-to-end using stochastic
gradient descent. In particular, we minimize a multi-task loss for detection and
motion forecasting: L = Ldet + λ · Lforecast
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 9
N X
X T
Lforecast = `δ (ynt − yn,GT
t
) + β · KL (qφ (Z|X, YGT ) ||pγ (Z|X))
n t
where the first term minimizes the reconstruction error between all the trajec-
tories in the scene Y = {ynt |∀n, t} = fθ (Z), Z ∼ qφ (Z|X, YGT ) and their corre-
sponding ground-truth YGT , and the second term brings the privileged posterior
qφ (Z|X, YGT ) and the approximate prior pγ (Z|X) distributions closer.
4 Experimental Evaluation
In this section, we first explain the metrics and baselines we use for evaluation.
Next, we compare our model against state-of-the-art motion forecasting algo-
rithms on predicting the future 5 second trajectories on two real-world datasets:
ATG4D [62] and nuScenes [8] (see supplementary for details). Then, we mea-
sure the impact on motion planning. Finally, we carry out an ablation study to
understand which part of our model contributes the most.
Previous methods use sample quality metrics at the actor level such as the popu-
lar minimum/mean average displacement error (minADE/meanADE). However,
these metrics only evaluate the quality of the underlying marginal distribution
per actor. For instance, minADE takes the trajectory sample that best fits the
ground-truth of each actor independently, which does not measure the consis-
tency between different actors sample trajectories and can be easily cheated by
predicting high entropy distributions that cover all the space but are not precise.
We propose scene-level sample quality metrics to evaluate how well the mod-
els capture the joint distribution over future outcomes. To this end, we define
a scene-level counterpart of the popular minimum/mean average displacement
error. We emphasize that in this context, each scene sample s ∈ 1, ..., S is a
10 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
4.2 Baselines
In this section, we discuss the state of the art motion forecasting models that
we use as baselines. It is important to note that most baselines are designed for
motion forecasting given perfect perception, i.e., ground-truth past trajectories.
However, this is not realistic in self-driving vehicles, which rely on imperfect noisy
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 11
perception. Thus, we adapt them to the realistic setting by replacing their past
trajectory encoders with our extracted actor features (see Fig. 3) and training
end-to-end with our perception backbone (see supplementary for details).
Independent output: We benchmark against SpAGNN [9], MTP [12], Mul-
tiPath [11], RulesRoad [20], and R2P2-MA [50]. Since the trajectory sam-
pling process from these models is independent per actor, we define a scene
sample s by drawing one sample for each actor in the scene.
Social auto-regressive: We compare against SocialLSTM [1], ESP [51],
MFP [57], and NRI [31]. It is worth sharing that for these baselines to achieve
competitive results we had to perturb the ground-truth trajectories with white
noise during training. This is because these models suffer from a distributional
shift between training and inference, as explained in Section 2. We note that
white noise was more effective than teacher forcing [33] or scheduled sampling [5].
showcases the full distribution learned by the models. More concretely, this plot
shows a Monte Carlo estimation of the marginal distribution per actor, where
50 samples are drawn from each model. Transparency in the plots illustrates
the probability density at a given location. These examples support the same
conclusion taken from the quantitative results and highlight the ability of our
model to understand complex road geometries and the multi-modal behaviors
they induce. This is particularly interesting since all models share the same
representation of the environment and backbone architecture.
To show that our improvements generalize to a dataset with a different dis-
tribution of motions and road topologies, we validate our method on nuScenes.
Table 2, shows that ILVM brings improvements over the baselines across all
metrics. In particular, we observe significant gains in scene-consistency (SCR)
and precision metrics (meanSADE and meanSFDE).
where p(Y |X) is the distribution over future trajectories output by the per-
ception and prediction model, T is a predefined set of SDV trajectories given
the map and high-level route, and c is a costing function that measures safety
and comfort taking into account the motion forecasts for the rest of the vehicles.
More concretely, the motion planner receives a Monte Carlo estimate of the fu-
ture trajectory distribution with S = 50 sample trajectories (see Fig.6) for every
detected vehicle (excluding the SDV), which are considered obstacles in order
to approximate the expected cost of plans τ ∈ T.
The experiments in Table 3 measure how different motion forecasts trans-
late into the safety and comfort of the SDV trajectory (τSDV ), an impact often
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 13
overlooked by previous works. Our motion forecasts (ILVM) enable the motion
planner to execute significantly safer and more comfortable trajectories. We no-
tice that the ego-motion plans make similar progress across models, but our
approach produces the closest trajectories to the expert demonstrations (lowest
`2 distance at 5 seconds into the future), while yielding much fewer collisions.
We include planning qualitative results in our supplementary material.
for our latent variable model. In particular, the large gap in scene level collision
demonstrates that our proposed SIM encoder and decoder capture scene-level
understanding that is not present in the ablations with independent assumptions
at the latent or output level.
References
1. Alahi, A., Goel, K., Ramanathan, V., Robicquet, A., Fei-Fei, L., Savarese, S.: Social
lstm: Human trajectory prediction in crowded spaces. In: Proceedings of the IEEE
CVPR (2016)
2. Battaglia, P.W., Hamrick, J.B., Bapst, V., Sanchez-Gonzalez, A., Zambaldi, V.,
Malinowski, M., Tacchetti, A., Raposo, D., Santoro, A., Faulkner, R., Gulcehre,
C., Song, F., Ballard, A., Gilmer, J., Dahl, G., Vaswani, A., Allen, K., Nash,
C., Langston, V., Dyer, C., Heess, N., Wierstra, D., Kohli, P., Botvinick, M.,
Vinyals, O., Li, Y., Pascanu, R.: Relational inductive biases, deep learning, and
graph networks (2018)
3. Behbahani, F., Shiarlis, K., Chen, X., Kurin, V., Kasewa, S., Stirbu, C., Gomes,
J., Paul, S., Oliehoek, F.A., Messias, J., et al.: Learning from demonstration in the
wild. 2019 International Conference on Robotics and Automation (ICRA) (May
2019). [Link]
4. Behrisch, M., Bieker, L., Erdmann, J., Krajzewicz, D.: Sumo–simulation of urban
mobility: an overview. In: Proceedings of SIMUL 2011, The Third International
Conference on Advances in System Simulation. ThinkMind (2011)
5. Bengio, S., Vinyals, O., Jaitly, N., Shazeer, N.: Scheduled sampling for sequence
prediction with recurrent neural networks. In: Advances in Neural Information
Processing Systems. pp. 1171–1179 (2015)
6. Best, A., Narang, S., Pasqualin, L., Barber, D., Manocha, D.: Autonovi-sim: Au-
tonomous vehicle simulation platform with weather, sensing, and traffic control.
In: 2018 IEEE/CVF Conference on Computer Vision and Pattern Recognition
Workshops (CVPRW). pp. 1161–11618 (2018)
7. Bhattacharyya, R.P., Phillips, D.J., Wulfe, B., Morton, J., Kuefler, A., Kochender-
fer, M.J.: Multi-agent imitation learning for driving simulation. 2018 IEEE/RSJ
International Conference on Intelligent Robots and Systems (IROS) (Oct 2018).
[Link]
8. Caesar, H., Bankiti, V., Lang, A.H., Vora, S., Liong, V.E., Xu, Q., Krishnan, A.,
Pan, Y., Baldan, G., Beijbom, O.: nuscenes: A multimodal dataset for autonomous
driving. arXiv preprint arXiv:1903.11027 (2019)
9. Casas, S., Gulino, C., Liao, R., Urtasun, R.: Spatially-aware graph neural
networks for relational behavior forecasting from sensor data. arXiv preprint
arXiv:1910.08233 (2019)
10. Casas, S., Luo, W., Urtasun, R.: Intentnet: Learning to predict intention from raw
sensor data. In: Conference on Robot Learning (2018)
11. Chai, Y., Sapp, B., Bansal, M., Anguelov, D.: Multipath: Multiple proba-
bilistic anchor trajectory hypotheses for behavior prediction. arXiv preprint
arXiv:1910.05449 (2019)
12. Cui, H., Radosavljevic, V., Chou, F.C., Lin, T.H., Nguyen, T., Huang, T.K., Schnei-
der, J., Djuric, N.: Multimodal trajectory predictions for autonomous driving using
deep convolutional networks. arXiv preprint arXiv:1809.10732 (2018)
13. Djuric, N., Radosavljevic, V., Cui, H., Nguyen, T., Chou, F.C., Lin, T.H., Schnei-
der, J.: Motion prediction of traffic actors for autonomous driving using deep con-
volutional networks. arXiv preprint arXiv:1808.05819 (2018)
14. Dosovitskiy, A., Ros, G., Codevilla, F., Lopez, A., Koltun, V.: CARLA: An open
urban driving simulator. In: Proceedings of the 1st Annual Conference on Robot
Learning. pp. 1–16 (2017)
16 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
15. Engelcke, M., Rao, D., Wang, D.Z., Tong, C.H., Posner, I.: Vote3deep: Fast object
detection in 3d point clouds using efficient convolutional neural networks. In: 2017
ICRA (2017)
16. Fu, H., Li, C., Liu, X., Gao, J., Celikyilmaz, A., Carin, L.: Cyclical annealing
schedule: A simple approach to mitigating. Proceedings of the 2019 Conference
of the North (2019). [Link] [Link]
10.18653/V1/N19-1021
17. Hardy, J., Campbell, M.: Contingency planning over probabilistic obstacle predic-
tions for autonomous road vehicles. IEEE Transactions on Robotics (2013)
18. Henaff, M., Canziani, A., LeCun, Y.: Model-predictive policy learning with uncer-
tainty regularization for driving in dense traffic. arXiv preprint arXiv:1901.02705
(2019)
19. Higgins, I., Matthey, L., Pal, A., Burgess, C., Glorot, X., Botvinick, M., Mohamed,
S., Lerchner, A.: beta-vae: Learning basic visual concepts with a constrained vari-
ational framework.
20. Hong, J., Sapp, B., Philbin, J.: Rules of the road: Predicting driving behavior
with a convolutional model of semantic interactions. In: The IEEE Conference on
Computer Vision and Pattern Recognition (CVPR) (June 2019)
21. Hoshen, Y.: Vain: Attentional multi-agent predictive modeling. In: Advances in
Neural Information Processing Systems. pp. 2701–2711 (2017)
22. Huang, J., Sivakumar, V., Mnatsakanyan, M., Pang, G.: Improving rotated text
detection with rotation region proposal networks (2018)
23. Hubmann, C., Schulz, J., Becker, M., Althoff, D., Stiller, C.: Automated driv-
ing in uncertain environments: Planning with interaction and uncertain maneuver
prediction. IEEE Transactions on Intelligent Vehicles 3(1), 5–17 (2018)
24. Huszár, F.: How (not) to train your generative model: Scheduled sampling, likeli-
hood, adversary? arXiv preprint arXiv:1511.05101 (2015)
25. Ivanovic, B., Pavone, M.: The trajectron: Probabilistic multi-agent trajectory mod-
eling with dynamic spatiotemporal graphs. In: Proceedings of the IEEE Interna-
tional Conference on Computer Vision. pp. 2375–2384 (2019)
26. Jain, A., Casas, S., Liao, R., Xiong, Y., Feng, S., Segal, S., Urtasun, R.: Dis-
crete residual flow for probabilistic pedestrian behavior prediction. arXiv preprint
arXiv:1910.08041 (2019)
27. Kim, B., Kang, C.M., Kim, J., Lee, S.H., Chung, C.C., Choi, J.W.: Probabilistic
vehicle trajectory prediction over occupancy grid map via recurrent neural network.
In: 2017 IEEE 20th International Conference on Intelligent Transportation Systems
(ITSC). pp. 399–404. IEEE (2017)
28. Kingma, D.P., Ba, J.: Adam: A method for stochastic optimization. arXiv preprint
arXiv:1412.6980 (2014)
29. Kingma, D.P., Welling, M.: Auto-encoding variational bayes. In: ICLR (2013)
30. Kingma, D.P., Welling, M.: Auto-encoding variational bayes. arXiv preprint
arXiv:1312.6114 (2013)
31. Kipf, T., Fetaya, E., Wang, K.C., Welling, M., Zemel, R.: Neural relational infer-
ence for interacting systems. arXiv preprint arXiv:1802.04687 (2018)
32. Klingelschmitt, S., Damerow, F., Eggert, J.: Managing the complexity of inner-city
scenes: An efficient situation hypotheses selection scheme. In: 2015 IEEE intelligent
vehicles symposium (IV). pp. 1232–1239. IEEE (2015)
33. Lamb, A.M., ALIAS PARTH GOYAL, A.G., Zhang, Y., Zhang, S., Courville,
A.C., Bengio, Y.: Professor forcing: A new algorithm for training re-
current networks. In: Lee, D.D., Sugiyama, M., Luxburg, U.V., Guyon,
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 17
51. Rhinehart, N., McAllister, R., Kitani, K., Levine, S.: PRECOG: PREdiction Con-
ditioned On Goals in Visual Multi-Agent Settings. arXiv e-prints arXiv:1905.01296
(May 2019)
52. Ridel, D., Deo, N., Wolf, D., Trivedi, M.: Scene compliant trajectory forecast with
agent-centric spatio-temporal grids. IEEE Robotics and Automation Letters (2020)
53. Ross, S., Gordon, G., Bagnell, D.: A reduction of imitation learning and struc-
tured prediction to no-regret online learning. In: Proceedings of the fourteenth
international conference on artificial intelligence and statistics. pp. 627–635 (2011)
54. Sadat, A., Ren, M., Pokrovsky, A., Lin, Y.C., Yumer, E., Urtasun, R.: Jointly
learnable behavior and trajectory planning for self-driving vehicles. arXiv preprint
arXiv:1910.04586 (2019)
55. Sadat, A., Ren, M., Pokrovsky, A., Lin, Y.C., Yumer, E., Urtasun, R.: Jointly
learnable behavior and trajectory planning for self-driving vehicles. arXiv preprint
arXiv:1910.04586 (2019)
56. Sohn, K., Lee, H., Yan, X.: Learning structured output representation using deep
conditional generative models. In: Advances in neural information processing sys-
tems. pp. 3483–3491 (2015)
57. Tang, C., Salakhutdinov, R.R.: Multiple futures prediction. In: Advances in Neural
Information Processing Systems. pp. 15398–15408 (2019)
58. Treiber, M., Hennecke, A., Helbing, D.: Congested traffic states in empirical ob-
servations and microscopic simulations. Physical review E (2000)
59. Wu, Y., He, K.: Group normalization. In: Proceedings of the ECCV (ECCV) (2018)
60. Yang, B., Guo, R., Liang, M., Sergio, C., Urtasun, R.: Exploiting radar for robust
perception of dynamic objects. In: ECCV (2020)
61. Yang, B., Liang, M., Urtasun, R.: Hdnet: Exploiting hd maps for 3d object detec-
tion. In: Conference on Robot Learning. pp. 146–155 (2018)
62. Yang, B., Luo, W., Urtasun, R.: Pixor: Real-time 3d object detection from point
clouds. In: Proceedings of the IEEE CVPR (2018)
63. Zeng, W., Luo, W., Suo, S., Sadat, A., Yang, B., Casas, S., Urtasun, R.: End-to-end
interpretable neural motion planner. In: Proceedings of the IEEE CVPR (2019)
64. Zeng, W., Wang, S., Liao, R., Chen, Y., Yang, B., Urtasun, R.: Dsdnet: Deep
structured self-driving network. In: ECCV (2020)
65. Zhou, Y., Sun, P., Zhang, Y., Anguelov, D., Gao, J., Ouyang, T., Guo, J., Ngiam,
J., Vasudevan, V.: End-to-end multi-view fusion for 3d object detection in lidar
point clouds. arXiv preprint arXiv:1910.06528 (2019)
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 19
Supplementary Material
In the following supplementary materials, we provide: additional discussions
of our method in the broader context of implicit generative models in Section A,
details about the datasets used in Section B, more implementation details in
Section C, more in-depth evaluation details and quantitative results in Section D,
and finally more visualizations in Section E.
from the conditional prior distribution p(z|x) and output y is generated from
the distribution p(y|x, z).
The learning objective for the conditional generative model is maximizing
the conditional log likelihood log p(y|x). But since marginalizing over continu-
ous latent variables z is intractable, it is typical to apply the Stochastic Gradient
Variational Bayes (SGVB) framework and optimize the following evidence vari-
ational lower bound (ELBO) instead:
log p(y|x) ≥ Eqφ (z|x,y) [log pθ (y|x, z)] − KL(qφ (z|x, y)||pγ (z|x))
Here, qφ (z|x, y) is the learned approximate posterior, pγ (z|x) the learned ap-
proximate prior, and pθ (y|x, z) the learned decoder.
Followup works have proposed further modifications to this objective to en-
courage disentanglement, prevent posterior collapse, and improve training sta-
bility. In this work, we follow [19] in extending the ELBO objective with an
additional hyperparameter β:
LELBO = −Eqφ (z|x,y) [log pθ (y|x, z)] + βKL(qφ (z|x, y)||pγ (z|x))
where cσ can be neglected since it is constant relative to µ, and thus does not
contribute to its gradient.
Empirically we found β = 0.05 to yield the best results. Under the inter-
pretation above, this would translate into using a fixed variance of 2.5cm while
learning our model. We note that this is extremely small in the context of mo-
tion forecasts (where vehicles can easily travel 50 meters in 5 seconds), and thus
consistent with our goal of approximating Y as a deterministic mapping from X
and Z, letting Z capture (nearly) all the uncertainty at a scene level.
B Datasets
We benchmark our approach on two datasets: ATG4D [62] and nuScenes [8].
This allow us to test the effectiveness of our approach in two vehicle platforms
with different LiDAR sensors and maps, driving in multiple cities across the
world.
ATG4D Our dataset contains more than one million frames collected over sev-
eral cities in North America with a 64-beam, roof-mounted LiDAR. Our labels
are very precise 3D bounding box tracks with a maximum distance from the
self-driving vehicle of 100 meters. There are 6500 snippets in total, each 25 sec-
onds long. In each city, we have access to high definition maps capturing the
geometry and the topology of each road network. Following previous works in
joint perception and motion forecasting [9, 10, 40] we consider a rectangular re-
gion centered around the self-driving vehicle that spans 144 meters along the
direction of its heading and 80 meters across. In these experiments, the model is
given one second of LiDAR history and has to predict 5 seconds into the future.
nuScenes This dataset consists of 1,000 snippets of 20 seconds each, collected
in Boston and Singapore (right-side vs. left-side driving). Their 32-beam LiDAR
captures a sparser point cloud than the one in ATG4D, making object detection
more challenging. High definition maps are also provided. We use the evaluation
setup proposed in their perception benchmark, where the previous 10 LiDAR
sweeps (0.5 seconds) are fed to the model, and the region of interest is a circle
of 50 meters radius around the SDV. The prediction horizon is 5 seconds.
C Implementation Details
the main input to our model. As in its follow-up work [61], we normalize the
height dimension with dense ground-height information provided by HD maps
for ATG4D dataset only (nuScenes does not provide this information). To
exploit motion cues, we leverage multiple LiDAR sweeps by compensating the
ego-motion (i.e. projecting the past sweeps to the coordinate frame of the cur-
rent sweep), as proposed by [40]. Following [10], we ravel the height and time
dimension into the channel dimension, to use 2D convolution to process spatial-
temporal information efficiently. The final representation is a 3D occupancy ten-
L W H·T
sor of dimensions ( ∆L , ∆W , ∆H·∆T ). Here, L = 144, W = 80, and H = 5 are
the spatial dimensions in meters. ∆L = ∆W = ∆H = 0.2 m/pixel are the reso-
lutions for the spatial dimensions, T = 5 seconds is the prediction horizon, and
∆T = 0.5 seconds/time-step is the time resolution.
Optimization Details: We use the Adam optimizer [28] with an initial learning
rate of 1.25e-5 and no weight decay. To weigh the multi-task objective, we use
[α, λ, β] = [0.1, 0.5, 0.05]. We follow [16] in using a cyclic annealing schedule for
β. More specifically, we perform warmup for 40k steps in 10k step cycles.
s
where the model predicts a normal distribution N yn,t |µn,t , Σn,t per waypoint
t, (An,t )T · An,t = Σn,t is the cholesky decomposition of the covariance matrix,
and εsn ∼ N (0, I) is the noise sampled from a standard bi-variate normal dis-
tribution. Note that the noise εsn is constant across time t for a given sample
s and actor n. Intuitively, having a constant noise across time steps allows us
to sample waypoints whose relative location with respect to its predicted mean
and covariance is constant across time (i.e. translated by the predicted mean
and scaled by the predicted covariance per time).
Fig. 7: Precision-Recall curve at IoU 0.5 and 0.7. Legend shows mAP (mean
Average Precision) for each model. Note: horizontal axis starts at 0.7 recall.
D.1 Detection
Fig. 7 shows that our model achieves the best detection performance at both
IoU thresholds. Since all models have the same backbone and detection header,
we conjecture that our learning objective eases the joint optimization of both
detection and motion forecasting.
Accurate model Low precision, high recall High precision, low recall
Actor-level vs. Scene-level metrics Fig. 9 motivates the need for scene-level
metrics to evaluate the characterization of the joint distribution over actors.
In particular, minFDE (actor-level minimum displacement error) will take the
minimum error trajectory for each actor regardless of which scene prediction it
belongs to. In contrast, minSFDE (our proposed scene-level counterpart) takes
the trajectories from the predicted scene with less average error across vehicles,
thus selecting the scene that is most consistent with the ground-truth as a whole.
Fig. 10: ILVM models social interaction consistently well at different recall levels.
N S
1 XX
Hit ynt,s , ŷnt , yn0 , ŷn0 ,
Hit Rate (y, ŷ, t, ) =
N S n=1 s=1
1 if IoU yn0 , ŷn0 > 0.5 and ||ynt,s − ŷnt ||2 <
Hit ynt,s , ŷnt , yn0 , ŷn0 , =
0 otherwise
Thus Hit Rate finds the percentage of samples that are true positive detec-
tions and have an L2 error below a threshold . We sweep values of 0.0m to
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 29
5.0m to get the broader curve which gives us the distribution on how likely each
model is to get a detection and sample close to the ground-truth. We do not
compute the metric above 5 meter error since we consider that to always be a
bad sample or ”miss”. Fig. 11 shows that Our ILVM significantly outperforms
all baselines in cumulative hit rate across across all time steps.
Fig. 11: ILVM obtains the best hit rate at all time-steps in the prediction horizon.
Fig. 12: Our ILVM outperforms more significantly in along track error than cross
track error for both scene-level minADE and minFDE metrics.
Fig. 13: Tradeoff between minSFDE and meanSFDE as model training pro-
gresses. Note that the minSFDE curve follows the y-axis on the left, and the
meanSFDE curve follows the y-axis on the right.
β SCR5s (%) min SFDE min SADE mean SFDE mean SADE
(m) (m) (m) (m)
0.01 1.41 1.70 0.84 2.58 1.17
0.03 0.89 1.59 0.79 2.37 1.06
0.05 0.70 1.53 0.76 2.27 1.02
0.5 0.64 1.85 0.85 1.90 0.86
1 0.64 1.87 0.87 1.95 0.88
1. High beta: model loses multimodality and predicts a single future without
variance. Low recall (minSADE) and high precision (meanSADE, collision).
High KL loss constrains the posterior to be close to the prior, thus limiting
the flexibility to encode useful information.
2. Low beta: model produces very high entropy distributions that try to cover
all possible futures at the expense of producing unrealistic samples. High
recall (minSADE) and low precision (meanSADE, collision). Low KL loss
allows the posterior to diverge from the prior, which creates a gap between
training and inference. Then at inference, the decoder struggles to interpret
latent samples from the prior distribution, which its not trained on.
E Additional Visualizations
Scene Consistency: In Figure 14, 15, 16, 17 we showcase the scene consistency
of the samples generated from our model. For these visualizations, each row
corresponds to a model, and we show 2 scene-level samples for each model to
characterize the joint distribution.
More concretely, we show the two most distinct samples by averaging the
pairwise Euclidean distance between all samples. We empirically find that this
selection methodology yields representative samples and insight into how well
the models learn scene-level social interaction between agents.
Latent Space Interpolation: In Figs. 18 and 19, we take the 2 most distinct
samples as in the previous scene sample visualizations, and show the resulting
futures when performing linear interpolation in the latent space. We show that
the interpolated latent points still produce semantically meaningful trajectories
for all the actors in the scene, and capture scene level variations including multi-
agent interactions. More precisely, Z 1 and Z 2 are the latent samples that map
into the most distinct futures out of 50. The rows in between correspond to
the linear interpolation of the latent space, and different columns to different
scenarios.
Overall Sample Quality: In Figs. 20, 21, 22, we show additional qualitative
results for motion forecasting, comparing our method to the baselines in a wide
32 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
range of urban scenarios, one per column. We blend 50 scene sample trajectories
with transparency. Time is encoded in the rainbow color map ranging from
red (0s) to pink (5s). This can be seen as a sample-based characterization of the
per-actor marginal distributions. We can see that our method generally produces
more accurate and less entropic distributions that better understand the map
topology and multi-agent interactions.
Sample 1 Sample 2
SpAGNN
MTP
MultiPath
R2P2
ESP
MFP
RoR
ILVM
Fig. 14: Scene-level samples. Our latent variable model captures complex in-
teractions at intersections. In this example, the car facing south will yield/go if
the car facing west goes straight/turns right, respectively. The baselines do not
capture this complex interaction, and most show inconsistent (colliding) samples
for the 2 highlighted actors.
34 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
Sample 1 Sample 2
SpAGNN
MTP
MultiPath
R2P2
ESP
MFP
RoR
ILVM
Fig. 15: Scene-level samples. Our latent variable model captures the different
scene outcomes for possible states of a given traffic light intersection (vertical
vs. horizontal traffic).
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 35
Sample 1 Sample 2
SpAGNN
MTP
MultiPath
R2P2
ESP
MFP
RoR
ILVM
Fig. 16: Scene-level samples. Our latent variable model captures whether the
bus will proceed with the right turn, or the left-turning vehicle will.
36 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
Sample 1 Sample 2
SpAGNN
MTP
MultiPath
R2P2
ESP
MFP
RoR
ILVM
Fig. 17: Scene-level samples. Our latent variable model captures multiple re-
alistic futures (including lane changes) that respect the map geometries and are
dynamically feasible.
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 37
Z1
Z2
Z1
Z2
SpAGNN
MTP
MultiPath
R2P2
ESP
MFP
RoR
ILVM Scenario 7 Scenario 8 Scenario 9
Fig. 22: Overall Sample Quality: We highlighted the accuracy and sharpness
of our predictions in Scenarios 7, 8 and 9.
42 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
Fig. 23: In this scenario, both MultiPath and ESP generate motion forecasts that
get into the SDV lane, forcing it to lane change to its right, where it collides
with an actual vehicle that is lane changing from behind the SDV and is not
well captured by the prediction models, including ours.
Implicit Latent Variable Model for Scene-Consistent Motion Forecasting 43
Fig. 24: In this scenario, the 3 models generate pulling out trajectories for a big
vehicle, forcing the SDV to maneuver to an unoccupied region. However, ILVM
captures well the distribution of the rest of the actors and the SDV performs
a safe left lane change. However, in ESP and MultiPath the trajectory of the
vehicle to the left is not well captured and the SDV proceeds too aggressively,
resulting in a collision.
44 S. Casas, C. Gulino, S. Suo, R. Liao, K. Luo, R. Urtasun
Fig. 25: ESP predicts that the vehicle that starts at the right of the SDV is going
to cut-off the SDV by lane changing left, causing the SDV to hard break and
causing a collision with the vehicle behind. MultiPath and ILVM successfully
drive through the scenario, even though we can see how MultiPath’s prediction
go even into opposite traffic, but luckily do not interfere the SDV.