//bool logFileIsOpen = false;
public LogFile(ref String MissionDateString, SettingsManager initializationSettings)
{
//NOTE: this is not the GPS-based dateTime ... and will be in error if the computer time is in error
MissionDateString =
DateTime.UtcNow.Year.ToString("D4") +
DateTime.UtcNow.Month.ToString("D2") +
DateTime.UtcNow.Day.ToString("D2") + "_" +
(3600 * DateTime.UtcNow.Hour + 60 * DateTime.UtcNow.Minute + DateTime.UtcNow.Second).ToString("D5");
logFileName = initializationSettings.SaveToFolder + MissionDateString + ".log";
logFile = new StreamWriter(logFileName);
logFile.AutoFlush = true;
//logFileIsOpen = true;
messageTimer = new Stopwatch();
messageTimer.Start();
//write banner for the logfile
logFile.WriteLine("//////////////////////////////////////////////////////////////");
logFile.WriteLine("Logfile initiated at " +
DateTime.Now.Month.ToString("D2") + "/" +
DateTime.Now.Day.ToString("D2") + "/" +
DateTime.Now.Year.ToString("D4") + " " +
DateTime.Now.Hour.ToString("D2") + ":" +
DateTime.Now.Minute.ToString("D2") + ":" +
DateTime.Now.Second.ToString("D2"));
logFile.WriteLine("//////////////////////////////////////////////////////////////");
logFile.WriteLine();
}
//constructor for MissionSelection Form for polygon mission
public MissionSelection(ProjectSummary _ps, String _FlightPlanFolder, LogFile _logFile,
NavInterfaceMBed navIF_In, SDKHandler cameraIn, bool hardwareAttached_, SettingsManager _settings, String _MissionDateString)
{
InitializeComponent();
posVel_ = new PosVel();
//set the flight plans folder and the Project Summary structure from the prior Project Selection
FlightPlanFolder = _FlightPlanFolder;
ps = _ps;
navIF_ = navIF_In;
camera = cameraIn;
hardwareAttached = hardwareAttached_;
settings = _settings;
MissionDateString = _MissionDateString;
logFile = _logFile;
projectName = ps.ProjectName;
//there is a separate constructor for the linearFeature coverage type
coverageType = COVERAGE_TYPE.polygon;
//getPosVelTimer = new Stopwatch();
utm = new UTM2Geodetic();
/////////////////////////////////////////////////////////////////////////////////////
//set up the project polygon and the individual Mission polygons in pixel units
/////////////////////////////////////////////////////////////////////////////////////
//set of points in Pixels that we use to draw the project polygon onto the project map
//creats space for an array of Point structures tha will hold the project polygon
projectPolyPointsPix = new Point[ps.ProjectPolygon.Count];
//lat/lon image bounds from the mission plan
ib = ps.ProjectImage; //placeholder for the project image bounds NOTE: this is also used elsewhere
//multiplier used for pix-to-geodetic conversion for the project map -- scales lat/lon to pixels
// TODO: ugly --- cant we do this exactly???
//lon2PixMultiplier = mapScaleFactor * mapWidth / (ib.eastDeg - ib.westDeg);
//lat2PixMultiplier = -mapScaleFactor * mapHeight / (ib.northDeg - ib.southDeg); //"-" cause vertical map direction is positive towards the south
lon2PixMultiplier = mapWidth / (ib.eastDeg - ib.westDeg);
lat2PixMultiplier = -mapHeight / (ib.northDeg - ib.southDeg); //"-" cause vertical map direction is positive towards the south
//create the project polygon in pixel units -- once
for (int i = 0; i < ps.ProjectPolygon.Count; i++)
projectPolyPointsPix[i] = GeoToPix(ps.ProjectPolygon[i]); //just uses a linear scaling
//create the mission polygons (one per mission) in pixel units
//used to form the clickable region on the project map
missionPolysInPix = new List<Point[]>();
for (int i = 0; i < ps.msnSum.Count; i++)
{
Point [] pts = new Point[ps.msnSum[i].missionGeodeticPolygon.Count];
for (int j = 0; j < ps.msnSum[i].missionGeodeticPolygon.Count; j++)
pts[j] = GeoToPix(ps.msnSum[i].missionGeodeticPolygon[j]);
missionPolysInPix.Add(pts);
}
}
int volumeChangedCounter; //used to measure the times of the "volume changed" events (two per download)
#endregion Fields
#region Constructors
/// <summary>
/// Initialises the SDK and adds events
/// </summary>
public SDKHandler(LogFile _logFile, SettingsManager settings)
{
Error = EDSDK.EdsInitializeSDK();
SDKStateEvent += new EDSDK.EdsStateEventHandler(Camera_SDKStateEvent);
SDKPropertyEvent += new EDSDK.EdsPropertyEventHandler(Camera_SDKPropertyEvent);
SDKObjectEvent += new EDSDK.EdsObjectEventHandler(Camera_SDKObjectEvent);
logFile = _logFile;
photoParameters = new PhotoParameters();
photoStats = new PhotoStats();
PhotoInProgress = false;
photoTimer = new Stopwatch();
volumeChangedCounter = 0;
//get the camera list of attached cameras
CamList = GetCameraList();
if (CamList.Count == 0)
{
logFile.WriteLine("There are no attached cameras");
MessageBox.Show("There are no attached cameras");
return;
}
else if (CamList.Count > 1)
{
MessageBox.Show("Found more than one attached Canon camera");
logFile.WriteLine("There is more than one attached camera");
return;
}
//open the session with the first camera (only a single camera is allowed)
OpenSession(CamList[0]);
//label the camera type
String cameraDescription = MainCamera.Info.szDeviceDescription;
//label camera serial number
String cameraSN = GetSettingString((uint)EDSDK.PropID_BodyIDEx);
//label firmware
String cameraFirmware = GetSettingString((uint)EDSDK.PropID_FirmwareVersion);
//CameraHandler.SetSetting(EDSDK.PropID_SaveTo, (uint)EDSDK.EdsSaveTo.Camera);
//CameraHandler.SetSetting(EDSDK.PropID_SaveTo, (uint)EDSDK.EdsSaveTo.Host);
SetSetting(EDSDK.PropID_SaveTo, (uint)EDSDK.EdsSaveTo.Both);
SetCapacity(); //used to tell camera there is enough room on the PC HD (see codeproject tutorial)
//get the capacity and loading of the camera card storage drive
//also write out the names of the images to output
cameraStats = StorageAssessment();
//fill in the remainder of the camera parameters
cameraStats.cameraDescription = cameraDescription;
cameraStats.cameraSN = cameraSN;
cameraStats.cameraFirmware = cameraFirmware;
missionPlansFolder = settings.SaveToFolder;
if (!Directory.Exists(missionPlansFolder)) Directory.CreateDirectory(missionPlansFolder);
if (!Directory.Exists(missionPlansFolder + @"/TestImages/"))
Directory.CreateDirectory(missionPlansFolder + @"/TestImages/");
//default value -- update this
ImageSaveDirectory = missionPlansFolder + @"/TestImages/";
/////////////////////////////////////////////////////
// camera settings for WaldoAir Flight Operations
/////////////////////////////////////////////////////
try
{
//set the aperture ---
SetSetting(EDSDK.PropID_Av, CameraValues.AV(settings.Camera_fStop));
logFile.WriteLine("Set the fStop: " + settings.Camera_fStop);
//set the shutter speed
SetSetting(EDSDK.PropID_Tv, CameraValues.TV(settings.Camera_shutter));
logFile.WriteLine("Set the shutter: " + settings.Camera_shutter);
//set the ISO
SetSetting(EDSDK.PropID_ISOSpeed, CameraValues.ISO(settings.Camera_ISO));
logFile.WriteLine("Set the ISO: " + settings.Camera_ISO);
//set the white balance to Daylight
SetSetting(EDSDK.PropID_WhiteBalance, EDSDK.WhiteBalance_Daylight);
logFile.WriteLine("Set the WhiteBalance: DayLight");
}
catch
{
logFile.WriteLine(" could not set the camera parameters");
MessageBox.Show("Problem setting the Camera parameters");
}
}
void checkForAndValidateFilesNeeded()
{
//get initialization settings from the Settings.txt file
initializationSettings = new SettingsManager();
//initializationSettings.SaveToFolder is the location of the mission plan folder
//this is typically set to C://_Waldo_FCS
FlightPlanFolder = initializationSettings.SaveToFolder;
//set up the logging procedures for the application
logFile = new LogFile( ref MissionDateString, initializationSettings);
logFile.WriteLine("Mission DateString established: " + MissionDateString);
//this will be a temporary location for saving the log file
//this will be revised later after we select the mssion
//FlightLogFolder = initializationSettings.SaveToFolder + "logs//";
String[] ProjectFolders = null;
ProjectFileNames = new List<String>();
ProjectCoverageTypes = new List<COVERAGE_TYPE>();
//flight folder location "_Waldo_FS" at top of C drive
if (!Directory.Exists(FlightPlanFolder))
{
DialogResult res = MessageBox.Show("There is no mission plan folder (_Waldo_FCS) at the top of the C drive\n ... Use the default example? ",
"NO Mission Folder", MessageBoxButtons.YesNo);
if (res == DialogResult.No)
{
Environment.Exit(0);
}
else
{
FlightPlanFolder = Directory.GetCurrentDirectory() + "\\SampleMission\\";
if (Directory.Exists(FlightPlanFolder))
{
MessageBox.Show("There is no sample mission folder ...", "Terminating ...");
Environment.Exit(0);
}
}
}
////////////////////////////////////////////////////////////////////////////////////
//if we get here, we have located the flight plan folder and created a log folder
////////////////////////////////////////////////////////////////////////////////////
//get the list of projects in the FlightPlanFolder
ProjectFolders = Directory.GetFiles(FlightPlanFolder, "*.kml"); //all files ending in .kml
if (ProjectFolders.Count() == 0)
{
MessageBox.Show("There are no Projects in the FlightPlanFolder folder", "Terminating ... ");
Environment.Exit(0);
}
logFile.WriteLine("");
logFile.WriteLine("Opening Project plans");
foreach (String pth in ProjectFolders)
{
//open each of the .kml files to see if they are valid missions plans
//and detect either Polygon plans or LinearFeature Plans
String kmlFilename = FlightPlanFolder + Path.GetFileNameWithoutExtension(pth) + ".kml";
logFile.WriteLine("Project plan: " + kmlFilename);
COVERAGE_TYPE coverageType = COVERAGE_TYPE.notSet;
XmlTextReader tr = new XmlTextReader(kmlFilename); //associate the textReader with input file
ProjectKmlReadUtility ps = new ProjectKmlReadUtility(tr, ref coverageType);
//we will display only input kml files that are detected to be polygon of linearFeature types
if (coverageType != COVERAGE_TYPE.notSet)
{
//test for a matching Background folder
String BackgroundMapFolderName = FlightPlanFolder + Path.GetFileNameWithoutExtension(pth) + "_Background\\";
if (!Directory.Exists(BackgroundMapFolderName))
{
MessageBox.Show("Valid plan: " + pth + ", found but no matching Background maps folder\n skip this plan");
}
else
{
int validMaps = 0;
String[] mapFiles = Directory.GetFiles(BackgroundMapFolderName, "*.png"); //all files ending in .kml
foreach (String st in mapFiles)
{
String ss = Path.GetFileNameWithoutExtension(st);
if (ss == "ProjectMap" || ss == "Background_00")
{
validMaps++;
}
}
if (validMaps < 2)
{
MessageBox.Show(pth + ": maps not correct in Background Folder\n skip this plan");
break;
}
//have found a valid mission plan with matching Background maps.
ProjectFileNames.Add(Path.GetFileNameWithoutExtension(pth));
ProjectCoverageTypes.Add(coverageType);
}
}
else
{
MessageBox.Show(pth + ": Invalid mission plan\n id you use latest KML_Reader?\n skip this plan");
}
}
//test for no valid mission plans
if (ProjectFileNames.Count == 0)
{
MessageBox.Show("There are no valid Polygon or LinearFeature projects \nDid you use a valid mission planner?");
Environment.Exit(0);
}
logFile.WriteLine("Completed opening project plans");
logFile.WriteLine("");
}
public NavInterfaceMBed(LogFile _logFile, SettingsManager Settings)
{
logFile = _logFile; //file where we write the mbed navigation data and status message
//Thread reader/writer lock to prevent clobbering the posvel variable while it is being accessed
posvelLock = new ReaderWriterLockSlim();
comStatusMessageLock = new ReaderWriterLockSlim();
triggerTimeReceievdFromMbed = false; //set to true when we receive a 1PPS status message
//reset to false in the calling program when the status message is processed
//used to store the CRC results fpr the GPS messages received at the PC
GPS_PC_CRC = new GPSMessageCRC_atPC();
trigger = new Trigger();
computeCRC = new NovatelCRC(); //class to compute the Novatel CRC value (see their manual)
comStats = new CommStats(); //accumulated comm stats
commStatusMessage = new CommStatusMessage(); //per sec comm status message
navIFMutex_ = new Mutex(); //not sure we need this
////////////////////////////////////////////////////////////////////////////////////////////
//wait here in a loop unitl we have attached the USB cable to access the mbed device
////////////////////////////////////////////////////////////////////////////////////////////
initializeMbedSerialPort();
if (!serialInit_)
{
logFile.WriteLine("mbed serial port not found");
throw new Exception("no serial port found");
}
/////////////////////////////////////////////////////////////////////////////////////
//At this stage we have found the mbed port and have successfully opened the port
/////////////////////////////////////////////////////////////////////////////////////
logFile.WriteLine("Successfully opened the mbed device");
utm = new UTM2Geodetic();
posvelAt1PPS = new PosVel();
timeFrom1PPS = new Stopwatch();
//set up the communications interface thread
Thread mbedCommunication = new Thread(mbedCommunicationWorker);
mbedCommunication.IsBackground = false;
//start the communication and begin retrieving mbed messages
mbedCommunication.Start();
logFile.WriteLine("Completed starting the mbed communication thread");
if (mbedCommunication.IsAlive)
{
logFile.WriteLine("mbedCommunication thread is operating ");
}
else
{
logFile.WriteLine("mbed communication htread os not operating ");
MessageBox.Show("mbed comminication thread did not start ");
}
}
//constructor for MissionSelection Form Linear Feature mission
public MissionSelection(linearFeatureCoverageSummary _LFSum, String _FlightPlanFolder, LogFile _logFile,
NavInterfaceMBed navIF_In, SDKHandler cameraIn, bool hardwareAttached_, SettingsManager _settings, String _MissionDateString)
{
InitializeComponent();
posVel_ = new PosVel();
//set the flight plans folder and the Project Summary structure from the prior Project Selection
FlightPlanFolder = _FlightPlanFolder;
LFSum = _LFSum;
navIF_ = navIF_In;
camera = cameraIn;
hardwareAttached = hardwareAttached_;
settings = _settings;
MissionDateString = _MissionDateString;
logFile = _logFile;
projectName = LFSum.ProjectName;
//this is a specific constructor for the linear feature coverage type
coverageType = COVERAGE_TYPE.linearFeature;
getPosVelTimer = new Stopwatch();
utm = new UTM2Geodetic();
//lat/lon image bounds from the mission plan
ib = LFSum.ProjectImage; //placeholder for the project image bounds NOTE: this is also used elsewhere
//multiplier used for pix-to-geodetic conversion for the project map -- scales lat/lon to pixels
// TODO: ugly --- cant we do this exactly???
//lon2PixMultiplier = mapScaleFactor * mapWidth / (ib.eastDeg - ib.westDeg);
//lat2PixMultiplier = -mapScaleFactor * mapHeight / (ib.northDeg - ib.southDeg); //"-" cause vertical map direction is positive towards the south
lon2PixMultiplier = mapWidth / (ib.eastDeg - ib.westDeg);
lat2PixMultiplier = -mapHeight / (ib.northDeg - ib.southDeg); //"-" cause vertical map direction is positive towards the south
}
