Deleting your question and re-posting is not beneficial. If you wish to remind people about your question, you can edit it or post additional information.
Your current version of the question has omitted the fact that you have a lidar as well, which could be important for solving the problem by cross-correlating the information between the two devices.
I do not think you will find any built-in routines in MATLAB to do this detection, so you will probably need to develop an algorithm first.