示例#1
0
文件: masSpeed.c 项目: timburrow/ovj3
/* Get the current Module ID and see if it has changed since we last
   checked and updated things.  If it has changed, get numerous values
   from the controller and send to vnmrj to get it up to date.
   If the probe is unplugged then the same probe is plugged in again,
   all params will be set to defaults including a set point of 0.
   I will check for a change in set point from non-zero to zero also.

   checkModuleChange() MUST ONLY BE CALLED FROM WITHIN MASSpeed(),
   else it can be trying to send cmds to the controller at the same time
   MASSpeed() is sending cmds, and the return values get out of sync.
*/
void checkModuleChange() 
{
    char strRes[80];
    int  status;
    int  curSetPoint;

    sendToMASSpeed("MODULE\n");
    status = getMASSpeedResponseString(strRes);
    if(status == 1) {
        if(strcmp(strRes, module) != 0) {
            // New module name found, update the one we keep around
            strcpy(module, strRes);
            DPRINT1(1,"Found new Module %s\n", module);
            // Need to get all new params
            getAllParams();
            // No need to check set point below, our work is done.
            return;
        }
    }
    else {
        // Try clearing out controller and hope for better
        // luck next time.
        ckMASSpeedInternal();
    }

    // The module did not change.  However, if they unplugged and replugged,
    // the connector, the controller will reset itself.  Try looking at
    // the set point also if it was non-zero and see if it has changed
    // to zero.
    if(setPoint != 0) {
        sendToMASSpeed("SETP\n");
        status = getMASSpeedResponseInt(&curSetPoint);
        if(status == 1) {
            if(setPoint != curSetPoint) {
                setPoint = curSetPoint;
            // Need to get all new params
            getAllParams();
            }
        }
        else {
            // Try clearing out controller and hope for better
            // luck next time.
            ckMASSpeedInternal();
        }
    }
}
示例#2
0
文件: masSpeed.c 项目: timburrow/ovj3
void processMasMessage(char *msgBuf)
{
   char strRes[80];
   int len;
   int status;
   int response;

   /* For testing.  when a msg is sent to the msgQ manually, it
      does not have the \n, so add one. */
   len = strlen(msgBuf);
   if(msgBuf[len-1] != '\n') {
      strcat(msgBuf, "\n");
   }

   DPRINT1(1, "Message received for MAS Controller: %s\n", msgBuf);

   // The msg should start with "SET" or "GET".  The real difference
   // between these two, is that "SET" does not expect a return
   // value, and "GET" does expect a return.  The command
   // GET BEARING is special in that it needs to return 3 values.
   // It is the only cmd to return the name of a value followed
   // by an equal sign and then a value.  The general form of the
   // incoming message here should be "GET/SET CMD [value]"
   
   // Check first 3 char of msg for GET/SET
   if(strncmp(msgBuf, "SET", 3) == 0)
   {
      /* The controller return from all set commands should simply
         be the controller prompt of "\n>".
         Cmd strings received here (msgBuf) should be SET followed
         by the controller cmd string such as ACTSP which is followed
         by the value or values for that cmd.  It should also
         already have a \n at the end of the string so that it
         is ready to send to the controller after removing the
         leading SET in the string.  The msgBuf[4] is taking the
         string starting after the SET.
      */
      sendToMASSpeed(&msgBuf[4]);
      // The controller should just return its prompt.
      status = getMASSpeedResponseString(strRes);

      if(status != 1  ||  strRes[1] != '>')
      {
         if(strncmp(strRes, "SPEED LIMIT", 11) == 0)
         {
            errLogRet(LOGIT,debugInfo, "Trying to set speed over speed limit\n");
         }
         else
         {
            errLogRet(LOGIT,debugInfo, "Problem with controller sending cmd: %s\n    %s\n", 
                               &msgBuf[4], strRes);
         // Try clearing out controller and hope for better
         // luck next time.
            ckMASSpeedInternal();
         }
      }
      else
      {
         if(strncmp(msgBuf, "SET S", 5) == 0)
         {
            // If we set a new speed, ask the controller for
            // its current value to be sure it know what we ask for.
            sendToMASSpeed("SETP\n");
            status = getMASSpeedResponseInt(&response);
            if(status == 1)
            {
               // Set the current value into the NDDS structure
               pCurrentStatBlock->AcqSpinSet = response;
               sendConsoleStatus();

               // Save cur set point for test now and then
               setPoint = response;
            }
         }
      }
   }
   else if(strncmp(msgBuf, "GET", 3) == 0)
   {
      /* [4] means look at string after the "GET " in the command. */
      if(strncmp(&msgBuf[4], "BEARING", 7) == 0)
      {
         /* BEARING command returns results in the form:
            SPAN = 100
            ADJ = 6
            MAX = 26\n>
         */
         sendToMASSpeed("BEARING\n");
         status = getMASSpeedResponseString(strRes);
         if(status != 1) {
            errLogRet(LOGIT,debugInfo, "Problem with Bearing command\n   %s\n", strRes);
            // Try clearing out controller and hope for better
            // luck next time.
            ckMASSpeedInternal();
         }
      }
      /* MODULE  returns a text string */
      else if(strncmp(&msgBuf[4], "MODULE", 6) == 0) {
         /* The module ID will not be sent unless it has changed.
            set to empty and then to the received value.
         */
         pCurrentStatBlock->probeId1[0] = '\0';
         sendConsoleStatus();
         taskDelay(calcSysClkTicks(830)); /* 830 ms, or taskDelay(50); */

         sendToMASSpeed(&msgBuf[4]);
         status = getMASSpeedResponseString(strRes);
         if(status != 1) {
            errLogRet(LOGIT,debugInfo, "Problem with command: %s\n    %s\n", 
                               &msgBuf[4], strRes);
            // Try clearing out controller and hope for better
            // luck next time.
            ckMASSpeedInternal();
         }

         // Put the result in place to be sent up
         strcpy(pCurrentStatBlock->probeId1, strRes);
         // Tell it we have changed values
         sendConsoleStatus();

         // Save current module
         strcpy(module, strRes);
         DPRINT1(1, "MAS Probe Module: %s\n", module);
      }
      /* PROFILE returns a text string */
      else if(strncmp(&msgBuf[4], "PROFILE", 7) == 0) {
         sendToMASSpeed(&msgBuf[4]);
         status = getMASSpeedResponseString(strRes);
         if(status != 1) {
            errLogRet(LOGIT, debugInfo, 
                                  "Problem with command: %s\n    %s\n", 
                                  &msgBuf[4], strRes);

            // Try clearing out controller and hope for better
            // luck next time.
            ckMASSpeedInternal();
         }

      }
      /* SETP returns the current set point value in Hz. Set with S */
      else if(strncmp(&msgBuf[4], "SETP", 4) == 0) {
         sendToMASSpeed(&msgBuf[4]);
         status = getMASSpeedResponseInt(&response);
         if(status == 1) {
            // Set the current value into the NDDS structure
            pCurrentStatBlock->AcqSpinSet = response;
            sendConsoleStatus();

            // Save cur set point for test now and then
            setPoint = response;
         }
         else {
            errLogRet(LOGIT,debugInfo, 
                                  "Problem with command: %s\n    %s\n", 
                                  &msgBuf[4], strRes);
            // Try clearing out controller and hope for better
            // luck next time.
            ckMASSpeedInternal();
         }
      }
      /* ACTSP returns 0, 1 or 2.  Just forward the value. 
         This is the active setpoint in case the user is wanting
         to change between set points without changing SETP */
      else if(strncmp(&msgBuf[4], "ACTSP", 5) == 0) {
         sendToMASSpeed(&msgBuf[4]);
         status = getMASSpeedResponseString(strRes);
         if(status != 1) {
            errLogRet(LOGIT,debugInfo, "Problem with command: %s\n    %s\n", 
                               &msgBuf[4], strRes);
            // Try clearing out controller and hope for better
            // luck next time.
            ckMASSpeedInternal();
         }

      }
      /* SPEED LIMIT returns the current value as
         'MAX SPEED = value' */
      else if(strncmp(&msgBuf[4], "SPEED LIMIT", 11) == 0) {
         sendToMASSpeed(&msgBuf[4]);
         status = getMASSpeedResponseString(strRes);
         if(status != 1) {
            errLogRet(LOGIT,debugInfo, "Problem with command: %s\n    %s\n", 
                               &msgBuf[4], strRes);
            // Try clearing out controller and hope for better
            // luck next time.
            ckMASSpeedInternal();
         }

      }
      /* S stands for speed.  This gets the current speed in Hz.
         This test must be after all other S commands so that we
         do not catch the first letter of another command. */
      else if(strncmp(&msgBuf[4], "S", 1) == 0) {
         sendToMASSpeed(&msgBuf[4]);
         status = getMASSpeedResponseString(strRes);
         if(status != 1) {
            errLogRet(LOGIT, debugInfo,
                                  "Problem with command: %s\n    %s\n", 
                                  &msgBuf[4], strRes);
            // Try clearing out controller and hope for better
            // luck next time.
            ckMASSpeedInternal();
         }

      }             
      else if(strncmp(&msgBuf[4], "ALLPARAMS", 9) == 0) {
         getAllParams();
      }
      else {
         // Error
         errLogRet(LOGIT, debugInfo,
                           "Unknown speed controller command %s.  Skipping.\n",
                           msgBuf);
      }

   }
   else
   {
      // Error
      errLogRet(LOGIT, debugInfo,
                       "Problem with speed controller command %s.  Skipping.\n",
                       msgBuf);
   }
}
示例#3
0
文件: masSpeed.c 项目: timburrow/ovj3
/* Task to be spawned by startMASSpeed.  This task it to use a msgQ for
   a dual purpose.  #1 is to have waiting on the msgQ time out every few
   seconds so we can get the current speed and put it in the NDDS structure
   for sending to vnmrj.  #2 is that any request coming from vnmrj will
   be put into the msgQ and promptly dealt with.

   Thus, the same task sitting on a single msgQ will be waiting for 
   requests from vnmrj and basically looping to get the current speed
   and send back to vnmrj.
*/
void MASSpeed()
{
    int  response;
    int  status, mStatus;
    char msgBuf[MAX_MSG_LEN];
    long cycle=0;
    int  delay;
    int  len;

    DPRINT(1, "*** Starting MASSpeed in Sleep State\n");
    // Start up in sleep state.  It will be awaken when spintype is set
    MasSpeedTaskSleeping = TRUE;

    msgToMASSpeedCtl = msgQCreate(MAX_MSGS, MAX_MSG_LEN, MSG_Q_FIFO);
    checkModuleChange();

    // Get all param values and set into pCurrentStatBlock
    getAllParams();

    // convert CYCLE_DELAY in sec to clock ticks
    delay = clkRate * CYCLE_DELAY;
    while(1) {
        // Now and then, check to see if the probe module has changed.
        // If it has,  get all info and send back to vnmrj.
        if(!MasSpeedTaskSleeping) {
            if(cycle >= 20) {
                checkModuleChange();
                cycle = 0;
            }
            cycle++;
        }

        /* Either catch a message from vnmrj, or timeout and get the
           current speed and send it.
        */
        mStatus = msgQReceive(msgToMASSpeedCtl, msgBuf, MAX_MSG_LEN, delay);

        // If sleeping, just continue for another cycle of delay until
        // we are not sleeping.  Ignore all commands that come in.
        if(MasSpeedTaskSleeping)
            continue;

        /* Timeout of msgQReceive will return ERROR.  In our case,
           this simply means to get the speed and send it on. 
        */
        if(mStatus == ERROR) { 
            /* See if we need to exit this task */
            if(exitMas) {
                DPRINT(0, "Exiting MASSpeed Task\n");
                masSpeedTaskId = 0;
                close(masSpeedPort);
                return;
            }

            sendToMASSpeed("S\n");
            status = getMASSpeedResponseInt(&response);

            if(status == -1 && response == -2)
                errLogRet(LOGIT,debugInfo, 
                          "*** Trying to set speed higher than limit.\n");
            else if(status == -1)
                errLogRet(LOGIT,debugInfo, 
                        "*** Speed Controller had problem with 'S' command.\n");
            else {
                // Set the new response into the NDDS structure
                pCurrentStatBlock->AcqSpinAct = response;

                // Tell it we have changed a value
                sendConsoleStatus();

                DPRINT1(3, "MAS Current Speed = %d\n", response);

                // Save current and prev for setting LED
                prevMasSpeed = curMasSpeed;
                curMasSpeed = response;
                // Set the LED as appropriate
                checkSpinLEDMas ();

            }

        }
        /* If msgQReceive does not return ERROR, then we received a message
           which we need to process.
        */
        else {
           processMasMessage(msgBuf);
        }
    }
}
示例#4
0
文件: wma2010.c 项目: creamy/wma
int main( int argc, char *argv[] )
{

jobj = json_object_new_object();
char Age[3] = "";
char Key[3] = "";
char Sex[5] = "";
char Distance[10] = "";


sqlite3 *db;
  char *zErrMsg = 0;
  int rc;

   while( FCGI_Accept() >= 0 ) {
      printf( "Content-Type: text/plain\n\n" );
	getAllParams();
	getParam("age", Age);
	getParam("key", Key);
	getParam("sex", Sex);
	getParam("distace", Distance);





rc = sqlite3_open("wma2010.db", &db);
  if( rc ){
    printf("Can't open database: %s\n", sqlite3_errmsg(db));
    sqlite3_close(db);
  }

  char sql [128];

char table [7];
if (Key[0]=='c') {
	strcpy(table,"_road");
} else {
	strcpy(table,"_track");
}


	sprintf(sql,"SELECT %s FROM %s%s WHERE age=%s",Key,Sex,table,Age);

  rc = sqlite3_exec(db, sql, callback, 0, &zErrMsg);

  if( rc!=SQLITE_OK ){
    printf("SQL error: %s\n", zErrMsg);
  }

	sprintf(sql,"SELECT * FROM %s_key WHERE keycode='%s'",Sex,Key);

  rc = sqlite3_exec(db, sql, callback_final, 0, &zErrMsg);

  if( rc!=SQLITE_OK ){
    printf("SQL error: %s\n", zErrMsg);
  }
  sqlite3_close(db);

   }
   return 0;
}