ardupilot/Tools/ArdupilotMegaPlanner/georefimage.cs

329 lines
12 KiB
C#
Raw Normal View History

using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Drawing;
using System.Drawing.Imaging;
using System.IO;
using System.Windows.Forms;
namespace ArdupilotMega
{
class georefimage : Form
{
private OpenFileDialog openFileDialog1;
private MyButton BUT_browselog;
private MyButton BUT_browsedir;
private TextBox TXT_logfile;
private TextBox TXT_jpgdir;
private TextBox TXT_offsetseconds;
private MyButton BUT_doit;
private FolderBrowserDialog folderBrowserDialog1;
private Label label1;
private TextBox TXT_outputlog;
internal georefimage() {
InitializeComponent();
}
DateTime getPhotoTime(string fn)
{
DateTime dtaken = DateTime.MinValue;
try
{
Image myImage = Image.FromFile(fn);
PropertyItem propItem = myImage.GetPropertyItem(36867); // 36867 // 306
//Convert date taken metadata to a DateTime object
string sdate = Encoding.UTF8.GetString(propItem.Value).Trim();
string secondhalf = sdate.Substring(sdate.IndexOf(" "), (sdate.Length - sdate.IndexOf(" ")));
string firsthalf = sdate.Substring(0, 10);
firsthalf = firsthalf.Replace(":", "-");
sdate = firsthalf + secondhalf;
dtaken = DateTime.Parse(sdate);
myImage.Dispose();
}
catch { }
return dtaken;
}
List<string[]> readLog(string fn)
{
List<string[]> list = new List<string[]>();
StreamReader sr = new StreamReader(fn);
string lasttime = "0";
while (!sr.EndOfStream)
{
string line = sr.ReadLine();
if (line.ToLower().StartsWith("gps"))
{
string[] vals = line.Split(new char[] {',',':'});
if (lasttime == vals[1])
continue;
lasttime = vals[1];
list.Add(vals);
}
}
sr.Close();
sr.Dispose();
return list;
}
public void dowork(string logFile, string dirWithImages, float offsetseconds)
{
DateTime localmin = DateTime.MaxValue;
DateTime localmax = DateTime.MinValue;
DateTime startTime = DateTime.MinValue;
//logFile = @"C:\Users\hog\Pictures\farm 1-10-2011\100SSCAM\2011-10-01 11-48 1.log";
List<string[]> list = readLog(logFile);
//dirWithImages = @"C:\Users\hog\Pictures\farm 1-10-2011\100SSCAM";
string[] files = Directory.GetFiles(dirWithImages);
StreamWriter sw2 = new StreamWriter(dirWithImages + Path.DirectorySeparatorChar + "location.txt");
StreamWriter sw = new StreamWriter(dirWithImages + Path.DirectorySeparatorChar + "location.tel");
sw.WriteLine("version=1");
sw.WriteLine("#longitude and latitude - in degrees");
sw.WriteLine("#name utc longitude latitude height");
int first = 0;
foreach (string file in files)
{
if (file.ToLower().EndsWith(".jpg"))
{
DateTime dt = getPhotoTime(file);
if (startTime == DateTime.MinValue)
{
startTime = new DateTime(dt.Year, dt.Month, dt.Day, 0, 0, 0, 0, DateTimeKind.Utc).ToLocalTime();
foreach (string[] arr in list)
{
DateTime crap = startTime.AddMilliseconds(int.Parse(arr[1])).AddSeconds(offsetseconds);
if (localmin > crap)
localmin = crap;
if (localmax < crap)
localmax = crap;
}
Console.WriteLine("min " + localmin + " max " + localmax);
TXT_outputlog.AppendText("Log min " + localmin + " max " + localmax + "\r\n");
}
TXT_outputlog.AppendText("Photo " + Path.GetFileNameWithoutExtension(file) + " time " + dt + "\r\n");
foreach (string[] arr in list)
{
Application.DoEvents();
DateTime crap = startTime.AddMilliseconds(int.Parse(arr[1])).AddSeconds(offsetseconds);
if (first == 0)
{
TXT_outputlog.AppendText("Photo " + Path.GetFileNameWithoutExtension(file) + " " + dt + " vs Log " + crap + "\r\n");
TXT_outputlog.AppendText("offset should be about " + (dt -crap).TotalSeconds + "\r\n");
first++;
}
Console.Write("ph " + dt + " log " + crap + " \r");
if (dt.Equals(crap))
{
TXT_outputlog.AppendText("MATCH Photo " + Path.GetFileNameWithoutExtension(file) + " " + dt + "\r\n");
sw2.WriteLine(Path.GetFileNameWithoutExtension(file) + " " + arr[5] + " " + arr[4] + " " + arr[7]);
sw.WriteLine(Path.GetFileNameWithoutExtension(file) + "\t" + crap.ToString("yyyy:MM:dd HH:mm:ss") +"\t"+ arr[5] + "\t" + arr[4] + "\t" + arr[7]);
sw.Flush();
sw2.Flush();
Console.WriteLine(Path.GetFileNameWithoutExtension(file) + " " + arr[5] + " " + arr[4] + " " + arr[7] + " ");
break;
}
//Console.WriteLine(crap);
}
}
}
sw2.Close();
sw.Close();
MessageBox.Show("Done");
}
private void InitializeComponent()
{
this.openFileDialog1 = new System.Windows.Forms.OpenFileDialog();
this.BUT_browselog = new ArdupilotMega.MyButton();
this.BUT_browsedir = new ArdupilotMega.MyButton();
this.TXT_logfile = new System.Windows.Forms.TextBox();
this.TXT_jpgdir = new System.Windows.Forms.TextBox();
this.TXT_offsetseconds = new System.Windows.Forms.TextBox();
this.BUT_doit = new ArdupilotMega.MyButton();
this.folderBrowserDialog1 = new System.Windows.Forms.FolderBrowserDialog();
this.TXT_outputlog = new System.Windows.Forms.TextBox();
this.label1 = new System.Windows.Forms.Label();
this.SuspendLayout();
//
// openFileDialog1
//
this.openFileDialog1.FileName = "openFileDialog1";
//
// BUT_browselog
//
this.BUT_browselog.Location = new System.Drawing.Point(351, 12);
this.BUT_browselog.Name = "BUT_browselog";
this.BUT_browselog.Size = new System.Drawing.Size(75, 23);
this.BUT_browselog.TabIndex = 0;
this.BUT_browselog.Text = "Browse Log";
this.BUT_browselog.UseVisualStyleBackColor = true;
this.BUT_browselog.Click += new System.EventHandler(this.BUT_browselog_Click);
//
// BUT_browsedir
//
this.BUT_browsedir.Location = new System.Drawing.Point(351, 41);
this.BUT_browsedir.Name = "BUT_browsedir";
this.BUT_browsedir.Size = new System.Drawing.Size(75, 23);
this.BUT_browsedir.TabIndex = 1;
this.BUT_browsedir.Text = "Browse Directory";
this.BUT_browsedir.UseVisualStyleBackColor = true;
this.BUT_browsedir.Click += new System.EventHandler(this.BUT_browsedir_Click);
//
// TXT_logfile
//
this.TXT_logfile.Location = new System.Drawing.Point(28, 14);
this.TXT_logfile.Name = "TXT_logfile";
this.TXT_logfile.Size = new System.Drawing.Size(317, 20);
this.TXT_logfile.TabIndex = 2;
this.TXT_logfile.Text = "C:\\Users\\hog\\Pictures\\farm 1-10-2011\\100SSCAM\\2011-10-01 11-48 1.log";
//
// TXT_jpgdir
//
this.TXT_jpgdir.Location = new System.Drawing.Point(28, 43);
this.TXT_jpgdir.Name = "TXT_jpgdir";
this.TXT_jpgdir.Size = new System.Drawing.Size(317, 20);
this.TXT_jpgdir.TabIndex = 3;
this.TXT_jpgdir.Text = "C:\\Users\\hog\\Pictures\\farm 1-10-2011\\100SSCAM";
//
// TXT_offsetseconds
//
this.TXT_offsetseconds.Location = new System.Drawing.Point(180, 69);
this.TXT_offsetseconds.Name = "TXT_offsetseconds";
this.TXT_offsetseconds.Size = new System.Drawing.Size(100, 20);
this.TXT_offsetseconds.TabIndex = 4;
this.TXT_offsetseconds.Text = "0";
//
// BUT_doit
//
this.BUT_doit.Location = new System.Drawing.Point(194, 105);
this.BUT_doit.Name = "BUT_doit";
this.BUT_doit.Size = new System.Drawing.Size(75, 23);
this.BUT_doit.TabIndex = 5;
this.BUT_doit.Text = "Do It";
this.BUT_doit.UseVisualStyleBackColor = true;
this.BUT_doit.Click += new System.EventHandler(this.BUT_doit_Click);
//
// TXT_outputlog
//
this.TXT_outputlog.Anchor = ((System.Windows.Forms.AnchorStyles)((((System.Windows.Forms.AnchorStyles.Top | System.Windows.Forms.AnchorStyles.Bottom)
| System.Windows.Forms.AnchorStyles.Left)
| System.Windows.Forms.AnchorStyles.Right)));
this.TXT_outputlog.Location = new System.Drawing.Point(28, 144);
this.TXT_outputlog.Multiline = true;
this.TXT_outputlog.Name = "TXT_outputlog";
this.TXT_outputlog.ReadOnly = true;
this.TXT_outputlog.ScrollBars = System.Windows.Forms.ScrollBars.Both;
this.TXT_outputlog.Size = new System.Drawing.Size(398, 143);
this.TXT_outputlog.TabIndex = 6;
//
// label1
//
this.label1.AutoSize = true;
this.label1.Location = new System.Drawing.Point(94, 75);
this.label1.Name = "label1";
this.label1.Size = new System.Drawing.Size(78, 13);
this.label1.TabIndex = 7;
this.label1.Text = "Seconds offset";
//
// georefimage
//
this.ClientSize = new System.Drawing.Size(453, 299);
this.Controls.Add(this.label1);
this.Controls.Add(this.TXT_outputlog);
this.Controls.Add(this.BUT_doit);
this.Controls.Add(this.TXT_offsetseconds);
this.Controls.Add(this.TXT_jpgdir);
this.Controls.Add(this.TXT_logfile);
this.Controls.Add(this.BUT_browsedir);
this.Controls.Add(this.BUT_browselog);
this.Name = "georefimage";
this.ResumeLayout(false);
this.PerformLayout();
}
private void BUT_browselog_Click(object sender, EventArgs e)
{
openFileDialog1.Filter = "Logs|*.log";
openFileDialog1.ShowDialog();
if (File.Exists(openFileDialog1.FileName))
{
TXT_logfile.Text = openFileDialog1.FileName;
}
}
private void BUT_browsedir_Click(object sender, EventArgs e)
{
folderBrowserDialog1.ShowDialog();
if (folderBrowserDialog1.SelectedPath != "")
{
TXT_jpgdir.Text = folderBrowserDialog1.SelectedPath;
}
}
private void BUT_doit_Click(object sender, EventArgs e)
{
if (!File.Exists(TXT_logfile.Text))
return;
if (!Directory.Exists(TXT_jpgdir.Text))
return;
float seconds;
if (float.TryParse(TXT_offsetseconds.Text, out seconds) == false)
return;
BUT_doit.Enabled = false;
try
{
dowork(TXT_logfile.Text, TXT_jpgdir.Text, seconds);
}
catch { }
BUT_doit.Enabled = true;
}
}
}