LASreadItemRaw_POINT14.cs

//===============================================================================
//
//  FILE:  lasreaditemraw_point14.cs
//
//  CONTENTS:
//
//    Implementation of LASreadItemRaw for POINT14 items.
//
//  PROGRAMMERS:
//
//    martin.isenburg@rapidlasso.com  -  http://rapidlasso.com
//
//  COPYRIGHT:
//
//    (c) 2005-2012, martin isenburg, rapidlasso - tools to catch reality
//    (c) of the C# port 2014 by Shinta <shintadono@googlemail.com>
//
//    This is free software; you can redistribute and/or modify it under the
//    terms of the GNU Lesser General Licence as published by the Free Software
//    Foundation. See the COPYING file for more information.
//
//    This software is distributed WITHOUT ANY WARRANTY and without even the
//    implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
//
//  CHANGE HISTORY: omitted for easier Copy&Paste (pls see the original)
//
//===============================================================================

using System.IO;
using System.Runtime.InteropServices;

namespace laszip.net
{
	class LASreadItemRaw_POINT14 : LASreadItemRaw
	{
		[StructLayout(LayoutKind.Sequential, Pack=1)]
		struct LAStempReadPoint14
		{
			public int x;
			public int y;
			public int z;
			public ushort intensity;

			//public byte return_number : 4;
			public byte return_number { get { return (byte)(returns&0xF); } set { returns=(byte)((returns&0xF0)|(value&0xF)); } }
			//public byte number_of_returns_of_given_pulse : 4;
			public byte number_of_returns_of_given_pulse { get { return (byte)((returns>>4)&0xF); } set { returns=(byte)((returns&0xF)|((value&0xF)<<4)); } }
			public byte returns;

			//public byte classification_flags : 4;
			public byte classification_flags { get { return (byte)(flags&0xF); } set { flags=(byte)((flags&0xF0)|(value&0xF)); } }
			//public byte scanner_channel : 2;
			public byte scanner_channel { get { return (byte)((flags>>4)&3); } set { flags=(byte)((flags&0xCF)|((value&3)<<4)); } }
			//public byte scan_direction_flag : 1;
			public byte scan_direction_flag { get { return (byte)((flags>>6)&1); } set { flags=(byte)((flags&0xBF)|((value&1)<<6)); } }
			//public byte edge_of_flight_line : 1;
			public byte edge_of_flight_line { get { return (byte)((flags>>7)&1); } set { flags=(byte)((flags&0x7F)|((value&1)<<7)); } }
			public byte flags;

			public byte classification;
			public byte user_data;
			public short scan_angle;
			public ushort point_source_ID;
			public double gps_time;
		}

		public LASreadItemRaw_POINT14() { }

		public unsafe override void read(laszip_point item)
		{
			if(instream.Read(buffer, 0, 30)!=30) throw new EndOfStreamException();

			fixed(byte* pBuffer=buffer)
			{
				LAStempReadPoint14* p14=(LAStempReadPoint14*)pBuffer;

				item.X=p14->x;
				item.Y=p14->y;
				item.Z=p14->z;
				item.intensity=p14->intensity;
				if(p14->number_of_returns_of_given_pulse>7)
				{
					if(p14->return_number>6)
					{
						if(p14->return_number>=p14->number_of_returns_of_given_pulse)
						{
							item.number_of_returns_of_given_pulse=7;
						}
						else
						{
							item.number_of_returns_of_given_pulse=6;
						}
					}
					else
					{
						item.return_number=p14->return_number;
					}
					item.number_of_returns_of_given_pulse=7;
				}
				else
				{
					item.return_number=p14->return_number;
					item.number_of_returns_of_given_pulse=p14->number_of_returns_of_given_pulse;
				}
				item.scan_direction_flag=p14->scan_direction_flag;
				item.edge_of_flight_line=p14->edge_of_flight_line;
				item.classification=(byte)((p14->classification_flags<<5)|(p14->classification&31));
				item.scan_angle_rank=MyDefs.I8_CLAMP(MyDefs.I16_QUANTIZE(p14->scan_angle*0.006));
				item.user_data=p14->user_data;
				item.point_source_ID=p14->point_source_ID;
				item.extended_scanner_channel=p14->scanner_channel;
				item.extended_classification_flags=(byte)(p14->classification_flags&8); // TODO Häää?
				item.extended_classification=p14->classification;
				item.extended_return_number=p14->return_number;
				item.extended_number_of_returns_of_given_pulse=p14->number_of_returns_of_given_pulse;
				item.extended_scan_angle=p14->scan_angle;
				item.gps_time=p14->gps_time;
			}
		}

		byte[] buffer=new byte[30];
	}
}