using System;
using System.Collections.Generic;
using System.ComponentModel;
using System.Data;
using System.Drawing;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using System.Windows.Forms;

using System.IO;
using System.IO.Ports;

namespace CPFTrack
{
    public partial class Form1 : Form
    {
        public delegate void IUSBLUpdateHandler(object sender, IUSBLData e);
        public event IUSBLUpdateHandler OnIUSBLUpdate;

        public Form1()
        {
            InitializeComponent();
        }

        private SerialPort iusblSerialPort = new SerialPort();
        private static byte[] iusblMsgBuffer;
        private void Form1_Load(object sender, EventArgs e)
        {
            formStripChart = new FormStripChart(this);
            formStripChart.FormClosed += formStripChart_FormClosed;
            formStripChart.Show();

            iusblSerialPort.BaudRate = 9600;
            iusblSerialPort.DataBits = 8;
            iusblSerialPort.Handshake = Handshake.None;
            iusblSerialPort.Parity = Parity.None;
            iusblSerialPort.PortName = "COM5";
            iusblSerialPort.StopBits = StopBits.One;
            iusblMsgBuffer = new byte[iusblSerialPort.ReadBufferSize];
        
            iusblSerialPort.DataReceived += new SerialDataReceivedEventHandler(iusblSerialPort_DataReceived);

            iusblSerialPort.Open();

            timerIUSBL.Enabled = true;
        }

        private static double depthValue = 0.0;
        private static Random randomValue = new Random();

        private void UpdateStatus(IUSBLData args)
        {
            // Make sure someone is listening to event
            if (OnIUSBLUpdate == null) 
                return;

            //ProgressEventArgs args = new ProgressEventArgs(status);
            OnIUSBLUpdate(this, args);
        }

        public class IUSBLData : EventArgs
        {
            public double rangeValue = double.NaN;
            public double xValue = double.NaN;
            public double yValue = double.NaN;
            public double zValue = double.NaN;

            public DateTime timeStamp = new DateTime();
        }
        private static IUSBLData iusblData = new IUSBLData();

 
        FormStripChart formStripChart;
        private void newStripChartToolStripMenuItem_Click(object sender, EventArgs e)
        {
            if (formStripChart == null)
            {
                formStripChart = new FormStripChart(this);
                formStripChart.FormClosed += formStripChart_FormClosed;
                formStripChart.Show();
            }
            else
                formStripChart.Activate();
        }

        void formStripChart_FormClosed(object sender, FormClosedEventArgs e)
        {
            formStripChart = null;
        }

        private void exitToolStripMenuItem_Click(object sender, EventArgs e)
        {
            Application.Exit();
        }

        private string inString = string.Empty;
        private StringBuilder inSB = new StringBuilder(256);
        delegate void SetTextCallback(String msgString);
 
        private void iusblSerialPort_DataReceived(object sender, SerialDataReceivedEventArgs e)
        {

            //There is no accurate method for checking how many bytes are read 
            //unless you check the return from the Read method 
            int bytesRead = iusblSerialPort.Read(iusblMsgBuffer, 0, iusblMsgBuffer.Length);

            //For the example assume the data we are received is ASCII data. 
            inString += Encoding.ASCII.GetString(iusblMsgBuffer, 0, bytesRead);

            if (inString.Contains("\n"))
            {
                this.BeginInvoke(new SetTextCallback(parseIUSBL), new object[] { inString });
                inString = String.Empty;
            }
        }

        private static string[] inFields;
        private void parseIUSBL(String inString)
        {
            Console.WriteLine("Received: " + inString);

            inFields = inString.Split(',', 'R', 'X', 'Y', 'Z');

            iusblData.rangeValue = double.Parse(inFields[2]);
            if(inFields.Length > 5)
            {
                iusblData.xValue = double.Parse(inFields[4]);
                iusblData.yValue = double.Parse(inFields[6]);
                iusblData.zValue = double.Parse(inFields[8]);
            }
        }

        private void simIUSBL(StringBuilder inSB)
        {
            Console.WriteLine(inSB.ToString());

            depthValue = depthValue - randomValue.NextDouble();

            iusblData.xValue = 0.0;
            iusblData.yValue = 0.0;
            iusblData.zValue = depthValue;
            iusblData.timeStamp = DateTime.Now;

            //ProgressEventArgs args = new ProgressEventArgs("test status");

            tbIUSBLDepth.Text = iusblData.zValue.ToString("f1");
            tbIUSBLNorthing.Text = iusblData.yValue.ToString("f1");
            tbIUSBLEasting.Text = iusblData.xValue.ToString("f1");

            UpdateStatus(iusblData);

            //         writeKML(iusblData);
        }
        
        private static StreamWriter kmlFile = new StreamWriter("usblTrack.kml");
        private static StringBuilder sbTemp = new StringBuilder(128);
        private void writeKML(IUSBLData iusblData)
        {

            kmlFile.WriteLine(@"<?xml version=""1.0"" encoding=""UTF-8""?>");
            kmlFile.WriteLine(@"<kml xmlns=""http://www.opengis.net/kml/2.2"" ");
            kmlFile.WriteLine(@" xmlns:gx=""http://www.google.com/kml/ext/2.2"">");
            kmlFile.WriteLine("<Document>");
            kmlFile.WriteLine("   <Placemark>");
            kmlFile.WriteLine("      <gx:Track>");
            kmlFile.WriteLine("         <altitudeMode>absolute</altitudeMode>");

            for (int i = 1; i > -100; i--)
            {
                sbTemp.Clear();
                sbTemp.Append("         <gx:coord>-121.80 36.805 ");
                sbTemp.Append(i.ToString());
                sbTemp.Append("</gx:coord>");
                kmlFile.WriteLine(sbTemp.ToString());
            }

            kmlFile.WriteLine("      </gx:Track>");
            kmlFile.WriteLine("  </Placemark>");
            kmlFile.WriteLine("</Document>");
            kmlFile.WriteLine("</kml>");

            kmlFile.Close();
         }    
//   kmlFile.WriteLine(@"  <Placemark>\n');
//   kmlFile.WriteLine(@"     <name>Paragon</name>\n');
//   kmlFile.WriteLine(@"     <Model id="Paragon">\n');
//   kmlFile.WriteLine(@"        <Location id="Paragon Model Location">\n');
//   kmlFile.WriteLine(@"           <longitude>%3.9f</longitude>\n', lon(end));
//   kmlFile.WriteLine(@"           <latitude>%3.9f</latitude>\n', lat(end));
//   kmlFile.WriteLine(@"           <altitude>0</altitude>\n');
//   kmlFile.WriteLine(@"        </Location>\n');
//   kmlFile.WriteLine(@"        <Orientation>\n');
//   kmlFile.WriteLine(@"           <heading>%f</heading>\n', mod(heading + 180, 360));
//   kmlFile.WriteLine(@"           <tilt>0</tilt>\n');
//   kmlFile.WriteLine(@"           <roll>0</roll>\n');
//   kmlFile.WriteLine(@"        </Orientation>\n');
//   kmlFile.WriteLine(@"        <Scale>\n');
//   kmlFile.WriteLine(@"           <x>1</x>\n');
//   kmlFile.WriteLine(@"           <y>1</y>\n');
//   kmlFile.WriteLine(@"           <z>1</z>\n');
//   kmlFile.WriteLine(@"        </Scale>\n');
//   kmlFile.WriteLine(@"        <Link>\n');
//   kmlFile.WriteLine(@"           <href>Paragon.dae</href>\n');
//   kmlFile.WriteLine(@"        </Link>\n');
//   kmlFile.WriteLine(@"     </Model>\n');
//   kmlFile.WriteLine(@"  </Placemark>\n\n');
//
//   kmlFile.WriteLine(@"       <LookAt>\n');
//   kmlFile.WriteLine(@"          <longitude>%3.9f</longitude>\n', lon(end));
//   kmlFile.WriteLine(@"          <latitude>%3.9f</latitude>\n', lat(end));
//   kmlFile.WriteLine(@"          <altitude>%f</altitude>\n', GEZoom);
// % kmlFile.WriteLine(@"          <tilt>0</tilt>\n');
// % kmlFile.WriteLine(@"          <heading>0</heading>\n');
//   kmlFile.WriteLine(@"          <altitudeMode>relativeToGround</altitudeMode>\n');
//   kmlFile.WriteLine(@"       </LookAt>\n\n');
//
//   kmlFile.WriteLine(@"</Document>\n');
//   kmlFile.WriteLine(@"</kml>\n');
//    
//    fclose(fid);
//end
     
        private void Form1_FormClosing(object sender, FormClosingEventArgs e)
        {
            if (iusblSerialPort.IsOpen)
                iusblSerialPort.Close();
        }

        private static String outString = "POS V6,4 R100.00,X80.00,Y10.00,Z";
        private static double depth = 0.0;
        private void timerIUSBL_Tick(object sender, EventArgs e)
        {
            depth = depth - 1.0;
            Console.Write("Sending: " + outString + depth.ToString() + "\r\n");
            iusblSerialPort.Write(outString + depth.ToString() + "\r\n");
        }
    }
}