Development of Robot for 3D Measurement of Forest Environment