Lidar RPLidar A2M8 - Testing program on L476RG