Updated forest code and now taking constant distance for temp and gimbal