Sensix Wireless Sensor Network Middleware    Home    Project Page    Download    CVS  Hosted by

/home/brennan/Software/sensix/tools/sim/sim_sensory.cpp Go to the documentation of this file. /* * Copyright 2008. Los Alamos National Security, LLC. This material * was produced under U.S. Government contract DE-AC52-06NA25396 for * Los Alamos National Laboratory (LANL), which is operated by Los * Alamos National Security, LLC, for the Department of Energy. The * U.S. Government has rights to use, reproduce, and distribute this * software. NEITHER THE GOVERNMENT NOR LOS ALAMOS NATIONAL SECURITY, * LLC, MAKES ANY WARRANTY, EXPRESS OR IMPLIED, OR ASSUMES ANY LEGAL * LIABILITY FOR THE USE OF THIS SOFTWARE. If software is modified to * produce derivative works, such modified software should be clearly * marked, so as not to confuse it with the version available from LANL. * * Additionally, this program is free software; you can redistribute * it and/or modify it under the terms of the GNU General Public * License as published by the Free Software Foundation; version 2 of * the License. Accordingly, this program is distributed in the hope * it will be useful, but WITHOUT ANY WARRANTY; without even the * implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR * PURPOSE. See the GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. */ #include <wx/wx.h> #include <wx/image.h> #include <wx/splash.h> #include <wx/ffile.h> #include <wx/numdlg.h> #include <igraph/igraph.h> #include <iostream> #include <vector> #include <algorithm> #include "sim_sensory.h" #include "sim_sensory_field.h" #include "sim_phenomena.h" #include "AboutDialog.h" #include "SenseDialog.h" #include "icon.xpm" #include "splash.xpm" #define AXIS_MIN 10 #define AXIS_MAX 1000000 #define AXIS_DEFAULT 1000 IMPLEMENT_APP(SimSensory) SimSensory::SimSensory() { splash = true; wxHandleFatalExceptions(); } bool SimSensory::OnInit() { if (wxApp::OnInit() == false) return false; logger = new wxLogStream::wxLogStream(&std::cerr); wxLog::SetActiveTarget(logger); wxLogDebug(_("Debugging output activated.")); wxInitAllImageHandlers(); SimSensoryExtra* frame = new SimSensoryExtra(NULL, wxID_ANY, wxEmptyString); frame->SetIcon(wxIcon(icon_xpm)); SetTopWindow(frame); if (splash) { new wxSplashScreen(wxBitmap(splash_xpm), wxSPLASH_CENTRE_ON_PARENT|wxSPLASH_TIMEOUT, 2000, frame, wxID_ANY); wxYieldIfNeeded(); } frame->Show(); return true; } void SimSensory::OnInitCmdLine(wxCmdLineParser& parser) { const wxCmdLineEntryDesc command_line_descriptor[] = { #if 0 { wxCMD_LINE_SWITCH, wxT("h"), wxT("help"), _("display (optional) command line parameters"), wxCMD_LINE_VAL_NONE, wxCMD_LINE_OPTION_HELP }, #endif { wxCMD_LINE_NONE } }; parser.SetDesc(command_line_descriptor); parser.SetSwitchChars(wxT("-")); } bool SimSensory::OnCmdLineParsed(wxCmdLineParser& parser) { if (parser.GetParamCount() > 0) { parser.Usage(); return false; } return true; } void SimSensory::OnFatalException() { GenerateReport(wxDebugReport::Context_Exception); } void SimSensory::GenerateReport(wxDebugReport::Context ctx) { wxDebugReportCompress *report = new wxDebugReportCompress; report->AddAll(ctx); wxFileName fn(report->GetDirectory(), _T("timestamp.dbg")); wxFFile file(fn.GetFullPath(), _T("w")); if (file.IsOpened()) { wxDateTime dt = wxDateTime::Now(); file.Write(dt.FormatISODate() + _T(' ') + dt.FormatISOTime()); file.Close(); } report->AddFile(fn.GetFullName(), _("timestamp of this report")); #ifndef __WXDEBUG__ if (wxDebugReportPreviewStd().Show(*report)) { #endif if (report->Process()) { wxLogMessage(_("Fatal Exception: report generated in \"%s\"."), report->GetCompressedFileName().c_str()); #ifdef __WXDEBUG__ /* TODO: print stack trace to stderr (with something like the following) for (int i = 3; i < report->stack.size; i++) wxLogError(_("%d %s: %s"), report->stack.frame[i].num, report->stack.frame[i].file, report->stack.frame[i].function); */ #endif report->Reset(); } #ifndef __WXDEBUG__ } #endif delete report; } SimSensoryExtra::SimSensoryExtra(wxWindow* parent, int id, const wxString& title, const wxPoint& pos, const wxSize& size, long style) : SimSensoryFrame(parent, id, title, pos, size, style) { const unsigned int accel_tbl_size = 5; wxAcceleratorEntry accel_entries[accel_tbl_size]; accel_entries[0].Set(wxACCEL_CTRL, (int)'N', wxID_NEW); accel_entries[1].Set(wxACCEL_CTRL, (int)'O', wxID_OPEN); accel_entries[2].Set(wxACCEL_CTRL, (int)'S', wxID_SAVE); accel_entries[3].Set(wxACCEL_CTRL, (int)'W', wxID_SAVEAS); accel_entries[4].Set(wxACCEL_CTRL, (int)'Q', wxID_EXIT); wxAcceleratorTable accel_tbl(accel_tbl_size, accel_entries); SetAcceleratorTable(accel_tbl); _file_name = NULL; _x_axis = AXIS_DEFAULT; _y_axis = AXIS_DEFAULT; _phenom = NONE; _on_path = false; _saved = true; } void SimSensoryExtra::onNew(wxCommandEvent& WXUNUSED(event)) { data.clear(); _phenom = NONE; _on_path = false; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); drop_field->refresh(); } void SimSensoryExtra::onOpen(wxCommandEvent& WXUNUSED(event)) { wxString prev_dir = wxT(""); wxString prev_name = wxT(""); if (_file_name != NULL && _file_name->IsOk()) { prev_dir = _file_name->GetPath(); prev_name = _file_name->GetFullName(); } wxFileDialog dialog(this, _("Open a new sensory data file"), prev_dir, prev_name, _T("Sensory data file|*.phenom"), wxOPEN); if (dialog.ShowModal() == wxID_OK) { wxFFile data_file; if (_file_name != NULL && _file_name->IsOk()) { delete _file_name; _file_name = NULL; } _file_name = new wxFileName(dialog.GetDirectory(), dialog.GetFilename()); if (!data_file.Open(_file_name->GetFullPath(), wxT("r"))) { wxLogError(_("Unable to open ") + _file_name->GetFullPath()); return; } if (read_scenario(data_file.fp(), data) < 0) { wxLogError(_("Unable to read ") + _file_name->GetFullPath()); } data_file.Close(); drop_field->refresh(); } } void SimSensoryExtra::onSave(wxCommandEvent& WXUNUSED(event)) { wxFFile data_file; if (_file_name != NULL && _file_name->IsOk()) { if (!data_file.Open(_file_name->GetFullPath(), wxT("w"))) { wxLogError(_("Unable to save to ") + _file_name->GetFullPath()); return; } for (int i = 0; i < data.size(); i++) { data_file.Write(wxString(data[i].toString(), wxConvUTF8)); } data_file.Close(); _saved = true; } } void SimSensoryExtra::onSaveAs(wxCommandEvent& event) { wxString prev_dir = wxT(""); if (_file_name !=NULL && _file_name->IsOk()) prev_dir = _file_name->GetPath(); wxFileDialog dialog(this, _("Save sensory data file as"), prev_dir, wxT(""), _T("Sensory data file|*.phenom"), wxSAVE); if (dialog.ShowModal() == wxID_OK) { if (_file_name != NULL && _file_name->IsOk()) { delete _file_name; _file_name = NULL; } _file_name = new wxFileName(dialog.GetDirectory(), dialog.GetFilename()); onSave(event); } } void SimSensoryExtra::onCompute(wxCommandEvent& event) { if(!_saved) onSave(event); wxString prev_dir = wxT(""); if (_file_name !=NULL && _file_name->IsOk()) prev_dir = _file_name->GetPath(); wxFileDialog net_dialog(this, _("Open node network graph"), prev_dir, wxT(""), _T("GML file|*.gml"), wxOPEN); if (net_dialog.ShowModal() == wxID_OK) { wxFileName net_filename(net_dialog.GetDirectory(), net_dialog.GetFilename()); prev_dir = net_dialog.GetDirectory(); wxLogDebug(_("Use ") + net_filename.GetFullPath() + _(" to compute adc file")); wxFileDialog adc_dialog(this, _("Save ADC simulation data as..."), prev_dir, wxT(""), _T("ADC data file|*.adc"), wxSAVE); if (adc_dialog.ShowModal() == wxID_OK) { wxFileName adc_filename(adc_dialog.GetDirectory(), adc_dialog.GetFilename()); wxLogDebug(_("Save as ") + adc_filename.GetFullPath()); if (net_filename.IsOk() && adc_filename.IsOk()) compute_adc(_file_name->GetFullPath().mb_str(), net_filename.GetFullPath().mb_str(), adc_filename.GetFullPath().mb_str()); } } } void SimSensoryExtra::onExit(wxCommandEvent& event) { onNew(event); Close(); } void SimSensoryExtra::onAbout(wxCommandEvent& WXUNUSED(event)) { AboutDialog dialog(this, wxID_ANY, _("About...")); if (dialog.ShowModal() == wxID_OK) ; // do nothing } void SimSensoryExtra::onXAxis(wxCommandEvent& WXUNUSED(event)) { _x_axis = wxGetNumberFromUser(wxEmptyString, _("Set X axis length: "), _("X axis"), _x_axis, AXIS_MIN, AXIS_MAX, this); statusbar->SetStatusText(wxString::Format(_("Size: x = %d, y = %d"), _x_axis, _y_axis), 1); drop_field->refresh(); } void SimSensoryExtra::onYAxis(wxCommandEvent& WXUNUSED(event)) { _y_axis = wxGetNumberFromUser(wxEmptyString, _("Set Y axis length: "), _("Y axis"), _y_axis, AXIS_MIN, AXIS_MAX, this); statusbar->SetStatusText(wxString::Format(_("Size: x = %d, y = %d"), _x_axis, _y_axis), 1); drop_field->refresh(); } void SimSensoryExtra::onAmbSound(wxCommandEvent& WXUNUSED(event)) { _phenom = AMBSOUND; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } void SimSensoryExtra::onAmbLight(wxCommandEvent& WXUNUSED(event)) { _phenom = AMBLIGHT; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } void SimSensoryExtra::onTemp(wxCommandEvent& WXUNUSED(event)) { _phenom = AMBTEMP; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } void SimSensoryExtra::onAmbRad(wxCommandEvent& WXUNUSED(event)) { _phenom = AMBRAD; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } void SimSensoryExtra::onSound(wxCommandEvent& WXUNUSED(event)) { _phenom = SOUND; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } void SimSensoryExtra::onLight(wxCommandEvent& WXUNUSED(event)) { _phenom = LIGHT; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } void SimSensoryExtra::onAccel(wxCommandEvent& WXUNUSED(event)) { _phenom = ACCEL_X; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } void SimSensoryExtra::onMag(wxCommandEvent& WXUNUSED(event)) { _phenom = MAG_X; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } void SimSensoryExtra::onRad(wxCommandEvent& WXUNUSED(event)) { _phenom = RAD; statusbar->SetStatusText(wxString(phenoms[_phenom], wxConvUTF8), 3); _on_path = false; } unsigned int SimSensoryExtra::getXAxis() { return _x_axis; } unsigned int SimSensoryExtra::getYAxis() { return _y_axis; } void SimSensoryExtra::setFieldPosition(double x, double y) { statusbar->SetStatusText(wxString::Format(_("Position: x = %d, y = %d"), _x_axis - static_cast<int>(x), static_cast<int>(y)), 0); } Phenom SimSensoryExtra::getCurrentPhenomType() { return _phenom; } void SimSensoryExtra::setSaved(bool s) { _saved = s; } bool SimSensoryExtra::isOnPath() { return _on_path; } void SimSensoryExtra::putOnPath() { _on_path = true; } void SenseDialog::onOK(wxCommandEvent& WXUNUSED(event)) { EndModal(wxID_OK); } void SenseDialog::onCancel(wxCommandEvent& WXUNUSED(event)) { EndModal(wxID_CANCEL); } SensoryField::SensoryField(wxWindow* parent, wxWindowID id) : wxPanel(parent, id) { _main = reinterpret_cast<SimSensoryExtra*>(parent); } BEGIN_EVENT_TABLE(SensoryField, wxPanel) EVT_PAINT(SensoryField::render) EVT_MOTION(SensoryField::onMove) EVT_LEFT_UP(SensoryField::onClick) EVT_RIGHT_DOWN(SensoryField::onCtrl) END_EVENT_TABLE() #define max(x, y) (x > y ? x : y) #define min(x, y) (x < y ? x : y) wxPoint SensoryField::_convertMouseToCoord(wxDC &dc, int x, int y) { wxPoint coord; coord.x = dc.DeviceToLogicalX(x); coord.y = dc.DeviceToLogicalY(y); return coord; } wxPoint SensoryField::_convertMouseToCoord(wxDC &dc, wxPoint &mouse) { return _convertMouseToCoord(dc, mouse.x, mouse.y); } void SensoryField::_paintField(wxDC &dc) { dc.Clear(); _prepDevice(dc); int x_len = static_cast<int>(_main->getXAxis() / 1000.0); int y_len = static_cast<int>(_main->getYAxis() / 1000.0); int len = min(x_len, y_len); for (int i = 0; i < _main->data.size(); i++) { SensorData d = _main->data[i]; wxString color(d.source->getColor(), wxConvUTF8); dc.SetPen(*wxTRANSPARENT_PEN); dc.SetBrush(wxBrush(color, wxSOLID)); if (d.source->isAmbient()) { wxPoint corner; wxSize size; AmbientPhenomenon *amb = reinterpret_cast<AmbientPhenomenon*>(d.source); size.Set(static_cast<int>(x_len * 8.0), static_cast<int>(y_len * 8.0)); corner.x = d.x - static_cast<int>(size.GetWidth() / 2.0); corner.y = d.y - static_cast<int>(size.GetHeight() / 2.0); dc.DrawEllipse(corner, size); switch (d.source->getType()) { case AMBSOUND: dc.SetBrush(wxBrush(color, wxVERTICAL_HATCH)); break; case AMBLIGHT: dc.SetBrush(wxBrush(color, wxHORIZONTAL_HATCH)); break; case AMBTEMP: dc.SetBrush(wxBrush(color, wxBDIAGONAL_HATCH)); break; case AMBRAD: dc.SetBrush(wxBrush(color, wxFDIAGONAL_HATCH)); break; } size.Set(x_len * amb->getRange(), y_len * amb->getRange()); corner.x = d.x - static_cast<int>(size.GetWidth() / 2.0); corner.y = d.y - static_cast<int>(size.GetHeight() / 2.0); int saved = dc.GetLogicalFunction(); dc.SetLogicalFunction(wxAND); dc.DrawEllipse(corner, size); dc.SetLogicalFunction(saved); } else { wxPoint corner; wxSize size; double x_size = max((x_len * 20.0), 2.0); double y_size = max((y_len * 20.0), 2.0); size.Set(static_cast<int>(x_size), static_cast<int>(y_size)); corner.x = d.x - static_cast<int>(x_size / 2.0); corner.y = d.y - static_cast<int>(y_size / 2.0); dc.DrawEllipse(corner, size); if (d.prev != NULL) { dc.SetPen(wxPen(wxT("black"), len, wxSOLID)); dc.DrawLine(d.x, d.y, d.prev->x, d.prev->y); } } } } void SensoryField::_prepDevice(wxDC &dc) { double win_x = GetSize().GetWidth(); double win_y = GetSize().GetHeight(); dc.SetAxisOrientation(true, true); dc.SetUserScale((win_x / _main->getXAxis()), (win_y / _main->getYAxis())); dc.SetLogicalOrigin(0, -_main->getYAxis()); dc.SetMapMode(wxMM_TEXT); } void SensoryField::render(wxPaintEvent& WXUNUSED(event)) { refresh(); } void SensoryField::refresh() { wxPaintDC dc(this); _paintField(dc); } void SensoryField::onMove(wxMouseEvent& event) { wxClientDC dc(this); _prepDevice(dc); wxPoint coord = _convertMouseToCoord(dc, event.m_x, event.m_y); coord.x = _main->getXAxis() - coord.x; _main->setFieldPosition(coord.x, coord.y); } void SensoryField::onClick(wxMouseEvent& event) { Phenom p = _main->getCurrentPhenomType(); if (p != NONE) { wxClientDC dc(this); _prepDevice(dc); wxPoint coord = _convertMouseToCoord(dc, event.m_x, event.m_y); wxLogDebug(_("Add ") + wxString(phenoms[p], wxConvUTF8) + wxString::Format(_(" at %d, %d"), coord.x, coord.y)); if (_main->isOnPath()) { SensorData *d = new SensorData(p, coord.x, coord.y, &_main->data.back()); d->on_path = true; _main->data.push_back(*d); } else { SensorData *d = new SensorData(p, coord.x, coord.y); _main->data.push_back(*d); _main->putOnPath(); } _paintField(dc); _main->setSaved(false); } } void SensoryField::onCtrl(wxMouseEvent& event) { wxClientDC dc(this); _prepDevice(dc); wxPoint coord = _convertMouseToCoord(dc, event.m_x, event.m_y); SensorData compare(NONE, coord.x, coord.y); std::vector<SensorData>::iterator result; result = std::find(_main->data.begin(), _main->data.end(), compare); if (result == _main->data.end()) return; SensorData datum = *result; wxLogDebug(_("Modify ")+ wxString(datum.source->toString(), wxConvUTF8) + wxString::Format(_(" at %d, %d"), coord.x, coord.y)); SenseDialog dialog(this, wxID_ANY, _("Modify sensory details")); dialog.SetPhenomenon(wxString(datum.source->toString(), wxConvUTF8)); if (datum.on_path) { if (datum.prev != NULL) dialog.SetStrength(datum.prev->strength); dialog.TimeOff(); dialog.SpeedOff(); dialog.AccelOff(); } else { dialog.DisableSpeed(); dialog.DisableAccel(); dialog.TimeOn(); } if (dialog.ShowModal() == wxID_OK) { long accel = -1; long speed = -1; datum.strength = dialog.GetStrength(); datum.source->setRate(dialog.GetRate()); if (dialog.IsTime()) { long long t = dialog.GetTime(); if (t > 0) { datum.time = t; if (datum.on_path && datum.prev) datum.speed = datum.distanceTo(*datum.prev) / (t - datum.prev->time); else datum.speed = 0; } } else if (dialog.IsSpeed()) { long s = dialog.GetSpeed(); if (s > 0 ) { datum.speed = s; if (datum.on_path && datum.prev) datum.time = datum.distanceTo(*datum.prev) / s; } } else if (dialog.IsAccel()) { long a = dialog.GetAccel(); if (a != 0 && datum.on_path && datum.prev) { long dist = datum.distanceTo(*datum.prev); accel = a; speed = datum.prev->speed; // NB: derived from two accel formulas: // d = u * t + (a * t * t) / 2 and // v - u = a * t where u is initial velocity datum.time = (2 * dist) / (unsigned long long)(sqrt(2 * a * dist + (speed * speed)) + speed); } } if (datum.on_path && datum.prev) { SensorData *last = datum.prev; long long t_diff = datum.time - datum.prev->time; int intervals = t_diff / datum.source->getRate(); for (int i = 0; i < intervals; i++) { unsigned int x, y; if (accel != -1) { // non-constant interval long long i_time = i * datum.source->getRate(); // NB: interval distance ratio, derived in part from // d = u * t + (a * t * t) / 2 long i_dist = ((speed * i_time) + ((accel * i_time * i_time) / 2)) / datum.distanceTo(*datum.prev); x = ((datum.x - datum.prev->x) * i_dist) + datum.prev->x; y = ((datum.y - datum.prev->y) * i_dist) + datum.prev->y; speed = speed * (accel / datum.source->getRate()); } else { // constant interval x = ((datum.x - datum.prev->x) * i) + datum.prev->x; y = ((datum.y - datum.prev->y) * i) + datum.prev->y; } SensorData *d = new SensorData(datum.source->getType(), x, y); d->time = datum.prev->time + (i * datum.source->getRate()); d->prev = last; _main->data.push_back(*d); last = d; } } } }

© 2008, Los Alamos National Security, LLC.