A system and method for state estimation of a surface of a platform at sea, includes receiving sensor signals indicative of LIDAR data for the platform; applying a Bayesian filter to the LIDAR data for a plurality of hypotheses; determining vertical planes representing azimuth and elevation angles for the LIDAR data; applying a robust linear estimation algorithm to the vertical planes; and determining candidate points in response to the applying of the robust linear estimation algorithm.