This paper develops an algorithm to compute optimal routes for an autonomous compost turner. In commercial composting, the material to be composted is piled up in large heaps called windrows and turned regularly by compost turners. The environment at the composting site is constantly changing, as the locations of the windrows change with each turning procedure. Therefore, we propose a novel method that automatically computes routes on a composting plant from LiDAR data. The LiDAR is mounted on the compost turner together with a dual-antenna GNSS receiver, an IMU, and rotary encoders. An extended Kalman filter is used to obtain the vehicle’s pose. Through direct georeferencing, a global point cloud is obtained. The routing algorithm crops, segments, and filters the point cloud until the points along the ridge of each windrow remain. These points are used to compute the optimal routes along each windrow. Furthermore, a user can select the windrows which need to be turned and the algorithm then computes the most efficient path for the compost turner, which also includes the passages between the windrows. The method was tested within a simulation environment using a 3D model of the composting site. The results show that the algorithm detects the windrows and computes the routes with sufficient accuracy for autonomous compost turning.