New upstream version 4.3.0upstream/4.3.0

1 files changed, 561 insertions, 0 deletions

diff --git a/app/bin/csensor.c b/app/bin/csensor.c
new file mode 100644
index 0000000..e962089
--- /dev/null
+++ b/app/bin/csensor.c
@@ -0,0 +1,561 @@
+/** \file csensor.c
+ * Sensors
+ */
+
+/* -*- C -*- ****************************************************************
+ *
+ *  System        : 
+ *  Module        : 
+ *  Object Name   : $RCSfile$
+ *  Revision      : $Revision$
+ *  Date          : $Date$
+ *  Author        : $Author$
+ *  Created By    : Robert Heller
+ *  Created       : Sun Mar 5 16:01:37 2017
+ *  Last Modified : <170314.1407>
+ *
+ *  Description	
+ *
+ *  Notes
+ *
+ *  History
+ *	
+ ****************************************************************************
+ *
+ *    Copyright (C) 2017  Robert Heller D/B/A Deepwoods Software
+ *			51 Locke Hill Road
+ *			Wendell, MA 01379-9728
+ *
+ *    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; either version 2 of the License, or
+ *    (at your option) any later version.
+ *
+ *    This program is distributed in the hope that 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., 675 Mass Ave, Cambridge, MA 02139, USA.
+ *
+ * 
+ *
+ ****************************************************************************/
+
+static const char rcsid[] = "@(#) : $Id$";
+
+#include <ctype.h>
+#include "track.h"
+#include "trackx.h"
+#include "compound.h"
+#include "i18n.h"
+
+EXPORT TRKTYP_T T_SENSOR = -1;
+
+static int log_sensor = 0;
+
+
+#if 0
+static drawCmd_t sensorD = {
+	NULL,
+	&screenDrawFuncs,
+	0,
+	1.0,
+	0.0,
+	{0.0,0.0}, {0.0,0.0},
+	Pix2CoOrd, CoOrd2Pix };
+
+static char sensorName[STR_SHORT_SIZE];
+static char sensorScript[STR_LONG_SIZE];
+#endif
+
+typedef struct sensorData_t {
+    coOrd orig;
+    BOOL_T IsHilite;
+    char * name;
+    char * script;
+} sensorData_t, *sensorData_p;
+
+static sensorData_p GetsensorData ( track_p trk )
+{
+    return (sensorData_p) GetTrkExtraData(trk);
+}
+
+#define RADIUS 6
+
+#define sensor_SF (3.0)
+
+static void DDrawSensor(drawCmd_p d, coOrd orig, DIST_T scaleRatio, 
+                         wDrawColor color )
+{
+    coOrd p1, p2;
+    
+    p1 = orig;
+    DrawFillCircle(d,p1, RADIUS * sensor_SF / scaleRatio,color);
+    Translate (&p2, orig, 45, RADIUS * sensor_SF / scaleRatio);
+    DrawLine(d, p1, p2, 2, wDrawColorWhite);
+    Translate (&p2, orig, 45+90, RADIUS * sensor_SF / scaleRatio);
+    DrawLine(d, p1, p2, 2, wDrawColorWhite);
+    Translate (&p2, orig, 45+180, RADIUS * sensor_SF / scaleRatio);
+    DrawLine(d, p1, p2, 2, wDrawColorWhite);
+    Translate (&p2, orig, 45+270, RADIUS * sensor_SF / scaleRatio);
+    DrawLine(d, p1, p2, 2, wDrawColorWhite);
+}
+
+static void DrawSensor (track_p t, drawCmd_p d, wDrawColor color )
+{
+    sensorData_p xx = GetsensorData(t);
+    DDrawSensor(d,xx->orig,GetScaleRatio(GetTrkScale(t)),color);
+}
+
+static void SensorBoundingBox (coOrd orig, DIST_T scaleRatio, coOrd *hi, 
+                                coOrd *lo)
+{
+    coOrd p1, p2;
+    
+    p1 = orig;
+    Translate (&p1, orig, 0, -RADIUS * sensor_SF / scaleRatio);
+    Translate (&p2, orig, 0, RADIUS * sensor_SF / scaleRatio);
+    *hi = p1; *lo = p1;
+    if (p2.x > hi->x) hi->x = p2.x;
+    if (p2.x < lo->x) lo->x = p2.x;
+    if (p2.y > hi->y) hi->y = p2.y;
+    if (p2.y < lo->y) lo->y = p2.y;
+}    
+
+
+static void ComputeSensorBoundingBox (track_p t )
+{
+    coOrd lo, hi;
+    sensorData_p xx = GetsensorData(t);
+    SensorBoundingBox(xx->orig, GetScaleRatio(GetTrkScale(t)), &hi, &lo);
+    SetBoundingBox(t, hi, lo);
+}
+
+static DIST_T DistanceSensor (track_p t, coOrd * p )
+{
+    sensorData_p xx = GetsensorData(t);
+    return FindDistance(xx->orig, *p);
+}
+
+static struct {
+    char name[STR_SHORT_SIZE];
+    coOrd pos;
+    char script[STR_LONG_SIZE];
+} sensorProperties;
+
+typedef enum { NM, PS, SC } sensorDesc_e;
+static descData_t sensorDesc[] = {
+    /* NM */ { DESC_STRING, N_("Name"),     &sensorProperties.name },
+    /* PS */ { DESC_POS,    N_("Position"), &sensorProperties.pos },
+    /* SC */ { DESC_STRING, N_("Script"),   &sensorProperties.script },
+    { DESC_NULL } };
+
+static void UpdateSensorProperties (  track_p trk, int inx, descData_p
+                                     descUpd, BOOL_T needUndoStart )
+{
+    sensorData_p xx = GetsensorData(trk);
+    const char *thename, *thescript;
+    char *newName, *newScript;
+    BOOL_T changed, nChanged, pChanged, sChanged;
+    
+    switch (inx) {
+    case NM:
+        break;
+    case PS:
+        break;
+    case SC:
+        break;
+    case -1:
+        changed = nChanged = pChanged = sChanged = FALSE;
+        thename = wStringGetValue( (wString_p) sensorDesc[NM].control0 );
+        if (strcmp(thename,xx->name) != 0) {
+            nChanged = changed = TRUE;
+            newName = MyStrdup(thename);
+        }
+        thescript = wStringGetValue( (wString_p) sensorDesc[SC].control0 );
+        if (strcmp(thescript,xx->script) != 0) {
+            sChanged = changed = TRUE;
+            newScript = MyStrdup(thescript);
+        }
+        if (sensorProperties.pos.x != xx->orig.x ||
+            sensorProperties.pos.y != xx->orig.y) {
+            pChanged = changed = TRUE;
+        }
+        if (!changed) break;
+        if (needUndoStart)
+            UndoStart( _("Change Sensor"), "Change Sensor" );
+        UndoModify( trk );
+        if (nChanged) {
+            MyFree(xx->name);
+            xx->name = newName;
+        }
+        if (pChanged) {
+            UndrawNewTrack( trk );
+        }
+        if (pChanged) {
+            xx->orig = sensorProperties.pos;
+        }
+        if (sChanged) {
+            MyFree(xx->script);
+            xx->script = newScript;
+        }
+        if (pChanged) { 
+            ComputeSensorBoundingBox( trk );
+            DrawNewTrack( trk );
+        }
+        break;
+    }
+}
+
+        
+
+static void DescribeSensor (track_p trk, char * str, CSIZE_T len )
+{
+    sensorData_p xx = GetsensorData(trk);
+    
+    strcpy( str, _(GetTrkTypeName( trk )) );
+    str++;
+    while (*str) {
+        *str = tolower((unsigned char)*str);
+        str++;
+    }
+    sprintf( str, _("(%d [%s]): Layer=%d, at %0.3f,%0.3f"),
+             GetTrkIndex(trk),
+             xx->name,GetTrkLayer(trk)+1, xx->orig.x, xx->orig.y);
+    strncpy(sensorProperties.name,xx->name,STR_SHORT_SIZE-1);
+    sensorProperties.name[STR_SHORT_SIZE-1] = '\0';
+    strncpy(sensorProperties.script,xx->script,STR_LONG_SIZE-1);
+    sensorProperties.script[STR_LONG_SIZE-1] = '\0';
+    sensorProperties.pos = xx->orig;
+    sensorDesc[NM].mode = 
+          sensorDesc[SC].mode = DESC_NOREDRAW;
+    DoDescribe( _("Sensor"), trk, sensorDesc, UpdateSensorProperties );
+}
+
+static void DeleteSensor ( track_p trk ) 
+{
+    sensorData_p xx = GetsensorData(trk);
+    MyFree(xx->name); xx->name = NULL;
+    MyFree(xx->script); xx->script = NULL;
+}
+
+static BOOL_T WriteSensor ( track_p t, FILE * f )
+{
+    BOOL_T rc = TRUE;
+    sensorData_p xx = GetsensorData(t);
+    rc &= fprintf(f, "SENSOR %d %d %s %d %0.6f %0.6f \"%s\" \"%s\"\n",
+                  GetTrkIndex(t), GetTrkLayer(t), GetTrkScaleName(t),
+                  GetTrkVisible(t), xx->orig.x, xx->orig.y, xx->name, 
+                  xx->script)>0;
+    return rc;
+}
+
+static void ReadSensor ( char * line )
+{
+    wIndex_t index;
+    /*TRKINX_T trkindex;*/
+    track_p trk;
+    /*char * cp = NULL;*/
+    char *name;
+    char *script;
+    coOrd orig;
+    BOOL_T visible;
+    char scale[10];
+    wIndex_t layer;
+    sensorData_p xx;
+    if (!GetArgs(line+7,"dLsdpqq",&index,&layer,scale, &visible, &orig,&name,&script)) {
+        return;
+    }
+    trk = NewTrack(index, T_SENSOR, 0, sizeof(sensorData_t));
+    SetTrkVisible(trk, visible); 
+    SetTrkScale(trk, LookupScale( scale ));
+    SetTrkLayer(trk, layer);
+    xx = GetsensorData ( trk );
+    xx->name = name;
+    xx->orig = orig;
+    xx->script = script;
+    ComputeSensorBoundingBox(trk);
+}
+
+static void MoveSensor (track_p trk, coOrd orig )
+{
+    sensorData_p xx = GetsensorData ( trk );
+    xx->orig.x += orig.x;
+    xx->orig.y += orig.y;
+    ComputeSensorBoundingBox(trk);
+}
+
+static void RotateSensor (track_p trk, coOrd orig, ANGLE_T angle )
+{
+}
+
+static void RescaleSensor (track_p trk, FLOAT_T ratio )
+{
+}
+
+static void FlipSensor (track_p trk, coOrd orig, ANGLE_T angle ) 
+{
+    sensorData_p xx = GetsensorData ( trk );
+    FlipPoint(&(xx->orig), orig, angle);
+    ComputeSensorBoundingBox(trk);
+}
+
+
+static trackCmd_t sensorCmds = {
+    "SENSOR",
+    DrawSensor,
+    DistanceSensor,
+    DescribeSensor,
+    DeleteSensor,
+    WriteSensor,
+    ReadSensor,
+    MoveSensor,
+    RotateSensor,
+    RescaleSensor,
+    NULL, /* audit */
+    NULL, /* getAngle */
+    NULL, /* split */
+    NULL, /* traverse */
+    NULL, /* enumerate */
+    NULL, /* redraw */
+    NULL, /* trim */
+    NULL, /* merge */
+    NULL, /* modify */
+    NULL, /* getLength */
+    NULL, /* getTrkParams */
+    NULL, /* moveEndPt */
+    NULL, /* query */
+    NULL, /* ungroup */
+    FlipSensor, /* flip */
+    NULL, /* drawPositionIndicator */
+    NULL, /* advancePositionIndicator */
+    NULL, /* checkTraverse */
+    NULL, /* makeParallel */
+    NULL  /* drawDesc */
+};
+
+static coOrd sensorEditOrig;
+static track_p sensorEditTrack;
+static char sensorEditName[STR_SHORT_SIZE];
+static char sensorEditScript[STR_LONG_SIZE];
+
+static paramFloatRange_t r_1000_1000    = { -1000.0, 1000.0, 80 };
+static paramData_t sensorEditPLs[] = {
+#define I_SENSORNAME (0)
+    /*0*/ { PD_STRING, sensorEditName, "name", PDO_NOPREF, (void*)200, N_("Name") },
+#define I_ORIGX (1)
+    /*1*/ { PD_FLOAT, &sensorEditOrig.x, "origx", PDO_DIM, &r_1000_1000, N_("Orgin X") }, 
+#define I_ORIGY (2)
+    /*2*/ { PD_FLOAT, &sensorEditOrig.y, "origy", PDO_DIM, &r_1000_1000, N_("Origin Y") },
+#define I_SENSORSCRIPT (3)
+    /*3*/ { PD_STRING, sensorEditScript, "script", PDO_NOPREF, (void*)350, N_("Script") },
+};
+
+static paramGroup_t sensorEditPG = { "sensorEdit", 0, sensorEditPLs, sizeof sensorEditPLs/sizeof sensorEditPLs[0] };
+static wWin_p sensorEditW;
+
+static void SensorEditOk ( void * junk )
+{
+    track_p trk;
+    sensorData_p xx;
+    
+    if (sensorEditTrack == NULL) {
+        UndoStart( _("Create Sensor"), "Create Sensor");
+        trk = NewTrack(0, T_SENSOR, 0, sizeof(sensorData_t));
+    } else {
+        UndoStart( _("Modify Sensor"), "Modify Sensor");
+        trk = sensorEditTrack;
+    }
+    xx = GetsensorData(trk);
+    xx->orig = sensorEditOrig;
+    if ( xx->name == NULL || strncmp (xx->name, sensorEditName, STR_SHORT_SIZE) != 0) {
+        MyFree(xx->name);
+        xx->name = MyStrdup(sensorEditName);
+    }
+    if ( xx->script == NULL || strncmp (xx->script, sensorEditScript, STR_LONG_SIZE) != 0) {
+        MyFree(xx->script);
+        xx->script = MyStrdup(sensorEditScript);
+    }
+    UndoEnd();
+    DoRedraw();
+    ComputeSensorBoundingBox(trk);
+    wHide( sensorEditW );
+}
+
+#if 0
+static void SensorEditCancel ( wWin_p junk )
+{
+    wHide( sensorEditW );
+}
+#endif
+
+static void EditSensorDialog()
+{
+    sensorData_p xx;
+    
+    if ( !sensorEditW ) {
+        ParamRegister( &sensorEditPG );
+        sensorEditW = ParamCreateDialog (&sensorEditPG,
+                                          MakeWindowTitle(_("Edit sensor")),
+                                          _("Ok"), SensorEditOk,
+                                          wHide, TRUE, NULL,
+                                          F_BLOCK,
+                                          NULL );
+    }
+    if (sensorEditTrack == NULL) {
+        sensorEditName[0] = '\0';
+        sensorEditScript[0] = '\0';
+    } else {
+        xx = GetsensorData ( sensorEditTrack );
+        strncpy(sensorEditName,xx->name,STR_SHORT_SIZE);
+        strncpy(sensorEditScript,xx->script,STR_LONG_SIZE);
+        sensorEditOrig = xx->orig;
+    }
+    ParamLoadControls( &sensorEditPG );
+    wShow( sensorEditW );
+}
+
+static void EditSensor (track_p trk)
+{
+    sensorEditTrack = trk;
+    EditSensorDialog();
+}
+
+static void CreateNewSensor (coOrd orig)
+{
+    sensorEditOrig = orig;
+    sensorEditTrack = NULL;
+    EditSensorDialog();
+}
+
+static STATUS_T CmdSensor ( wAction_t action, coOrd pos )
+{
+    
+    
+    switch (action) {
+    case C_START:
+        InfoMessage(_("Place sensor"));
+        return C_CONTINUE;
+    case C_DOWN:
+        SnapPos(&pos);
+        DDrawSensor( &tempD, pos, GetScaleRatio(curScaleInx), wDrawColorBlack );
+        return C_CONTINUE;
+    case C_MOVE:
+        SnapPos(&pos);
+        DDrawSensor( &tempD, pos, GetScaleRatio(curScaleInx), wDrawColorBlack );
+        return C_CONTINUE;
+    case C_UP:
+        SnapPos(&pos);
+        DDrawSensor( &tempD, pos, GetScaleRatio(curScaleInx), wDrawColorBlack );
+        CreateNewSensor(pos);
+        return C_TERMINATE;
+    case C_REDRAW:
+    case C_CANCEL:
+        DDrawSensor( &tempD, pos, GetScaleRatio(curScaleInx), wDrawColorBlack );
+        return C_CONTINUE;
+    default:
+        return C_CONTINUE;
+    }
+}
+
+static coOrd ctlhiliteOrig, ctlhiliteSize;
+static POS_T ctlhiliteBorder;
+static wDrawColor ctlhiliteColor = 0;
+static void DrawSensorTrackHilite( void )
+{
+	wPos_t x, y, w, h;
+	if (ctlhiliteColor==0)
+		ctlhiliteColor = wDrawColorGray(87);
+	w = (wPos_t)((ctlhiliteSize.x/mainD.scale)*mainD.dpi+0.5);
+	h = (wPos_t)((ctlhiliteSize.y/mainD.scale)*mainD.dpi+0.5);
+	mainD.CoOrd2Pix(&mainD,ctlhiliteOrig,&x,&y);
+	wDrawFilledRectangle( mainD.d, x, y, w, h, ctlhiliteColor, wDrawOptTemp );
+}
+
+static int SensorMgmProc ( int cmd, void * data )
+{
+    track_p trk = (track_p) data;
+    sensorData_p xx = GetsensorData(trk);
+    /*char msg[STR_SIZE];*/
+    
+    switch ( cmd ) {
+    case CONTMGM_CAN_EDIT:
+        return TRUE;
+        break;
+    case CONTMGM_DO_EDIT:
+        EditSensor(trk);
+        return TRUE;
+        break;
+    case CONTMGM_CAN_DELETE:
+        return TRUE;
+        break;
+    case CONTMGM_DO_DELETE:
+        DeleteTrack(trk, FALSE);
+        return TRUE;
+        break;
+    case CONTMGM_DO_HILIGHT:
+        if (!xx->IsHilite) {
+            ctlhiliteBorder = mainD.scale*0.1;
+            if ( ctlhiliteBorder < trackGauge ) ctlhiliteBorder = trackGauge;
+            GetBoundingBox( trk, &ctlhiliteSize, &ctlhiliteOrig );
+            ctlhiliteOrig.x -= ctlhiliteBorder;
+            ctlhiliteOrig.y -= ctlhiliteBorder;
+            ctlhiliteSize.x -= ctlhiliteOrig.x-ctlhiliteBorder;
+            ctlhiliteSize.y -= ctlhiliteOrig.y-ctlhiliteBorder;
+            DrawSensorTrackHilite();
+            xx->IsHilite = TRUE;
+        }
+        break;
+    case CONTMGM_UN_HILIGHT:
+        if (xx->IsHilite) {
+            ctlhiliteBorder = mainD.scale*0.1;
+            if ( ctlhiliteBorder < trackGauge ) ctlhiliteBorder = trackGauge;
+            GetBoundingBox( trk, &ctlhiliteSize, &ctlhiliteOrig );
+            ctlhiliteOrig.x -= ctlhiliteBorder;
+            ctlhiliteOrig.y -= ctlhiliteBorder;
+            ctlhiliteSize.x -= ctlhiliteOrig.x-ctlhiliteBorder;
+            ctlhiliteSize.y -= ctlhiliteOrig.y-ctlhiliteBorder;
+            DrawSensorTrackHilite();
+            xx->IsHilite = FALSE;
+        }
+        break;
+    case CONTMGM_GET_TITLE:
+        sprintf(message,"\t%s\t",xx->name);
+        break;
+    }
+    return FALSE;
+}
+
+#include "bitmaps/sensor.xpm"
+
+EXPORT void SensorMgmLoad ( void )
+{
+    track_p trk;
+    static wIcon_p sensorI = NULL;
+    
+    if (sensorI == NULL) {
+        sensorI = wIconCreatePixMap( sensor_xpm );
+    }
+    
+    TRK_ITERATE(trk) {
+        if (GetTrkType(trk) != T_SENSOR) continue;
+        ContMgmLoad (sensorI, SensorMgmProc, (void *) trk );
+    }
+}
+
+#define ACCL_SENSOR 0
+
+EXPORT void InitCmdSensor ( wMenu_p menu )
+{
+    AddMenuButton( menu, CmdSensor, "cmdSensor", _("Sensor"), 
+                   wIconCreatePixMap( sensor_xpm ), LEVEL0_50, IC_STICKY|IC_POPUP2, ACCL_SENSOR, NULL );
+}
+
+EXPORT void InitTrkSensor ( void )
+{
+    T_SENSOR = InitObject ( &sensorCmds );
+    log_sensor = LogFindIndex ( "sensor" );
+}