sensor_command.c

Go to the documentation of this file.

#include <sensors/sensor.h>
#include <sensors/sensor_command.h>
#include <platform-header.h>
extern struct sensordev sensors[];
 
 
// list all sensors
void sensor_com_list(struct command *com) {
  if (!sensors_inited()) {
    send_command_reply_with_args(com, COMFLAGS_ACK, "err=not inited yet");
    return;
  }
  struct command *dcom;
  const struct sensordev *sd;
  int t = 0;
 
  if (!all_sensors_probed()) {
    // not ready, yet send failure (ack w/o success)
    send_command_reply_with_args(com, COMFLAGS_ACK, "err=not ready yet");
    return;
  }
  dcom = alloc_command();
  if (dcom == NULL) {
    send_command_reply_with_args(com, COMFLAGS_ACK, "err=out of commands");
    return;
  }
  while (((sd = &sensors[t])->power_on) != NULL) {
    struct sensorruntime *sr = get_runtime(t);
    t++;
    if (sr == NULL) {
      continue;
    }
    command_init(dcom);
    dcom->target = com->sender;
    dcom->encoding = 'a';
    dcom->index = com->index;
    dcom->sourcedev = com->sourcedev;
    dcom->connid = com->connid;
    dcom->com = com->com;
    dcom->flags = COMFLAGS_DATA | COMFLAGS_SUCCESS;
    command_add_arg(dcom, "idx=%i", t);
    command_add_arg(dcom, "n=%s", sd->name);
    command_add_arg(dcom, "t=%s", sd->type);
    command_add_arg(dcom, "u=%s", sd->unit);
    command_add_arg(dcom, "up=%s", sd->unit_prefix);
    command_add_arg(dcom, "f=%i", sr->flags);
    command_add_arg(dcom, "l=%i", sr->valuesize);
    send_command(dcom);
    free_command(dcom);
  }
  send_command_reply_with_args(com, COMFLAGS_ACK | COMFLAGS_SUCCESS, "data_packets=%i", t);
}
// parse args: index int,activate bool, polliv int, repiv int (all ints as hex)
void sensor_com_config(struct command *com) {
  if (com->argctr != 4) {
    printf("inv sensor config command argctr==%i\r\n", com->argctr);
    send_command_reply_with_args(com, COMFLAGS_ACK, "err=invalid number of arguments");
    return;
  }
  long idx = ascii_parse_hex((const byte *)get_arg(com, 0), 8, NULL);
 
  if (idx < 1) {
    printf("invalid sensor 0\r\n");
    send_command_reply_with_args(com, COMFLAGS_ACK, "err=sensor 0 is not valid");
  }
  struct sensorruntime *sr = get_runtime(idx - 1);
  const struct sensordev *sdf = sr->sensor;
 
 
  long activate = ascii_parse_hex((const byte *)get_arg(com, 1), 8, NULL);
  long poll_frequency = ascii_parse_hex((const byte *)get_arg(com, 2), 8, NULL);
  long report_frequency = ascii_parse_hex((const byte *)get_arg(com, 3), 8, NULL);
 
  printf("[sensor] config: Sensor %i (%s) activate: %i, poll_frequency: %i, report_frequency: %i\r\n", idx, sdf->name, activate, poll_frequency, report_frequency);
  int r = sensor_update_config(com->sender, idx - 1, poll_frequency, report_frequency, 100);
 
  if (r) {
    char e[100];
    snprintf(e, 99, "err=failed to update config (errorcode=%i)", r);
    send_command_reply_with_args(com, COMFLAGS_ACK, e);
    return;
  }
  sensor_activation(sr, activate);
  send_command_reply(com, COMFLAGS_ACK | COMFLAGS_SUCCESS);
  sensors_newstyle();
}