sensor_hx71x: Update Sensors to report to load_cell_probe

Signed-off-by: Gareth Farrington <gareth@waves.ky>

1 files changed, 16 insertions, 0 deletions

diff --git a/src/sensor_ads1220.c b/src/sensor_ads1220.c
index ea33379a..f51dc355 100644
--- a/src/sensor_ads1220.c
+++ b/src/sensor_ads1220.c
@@ -11,6 +11,7 @@
 #include "command.h" // DECL_COMMAND
 #include "sched.h" // sched_add_timer
 #include "sensor_bulk.h" // sensor_bulk_report
+#include "load_cell_probe.h" // load_cell_probe_report_sample
 #include "spicmds.h" // spidev_transfer
 #include <stdint.h>
 
@@ -21,6 +22,7 @@ struct ads1220_adc {
     struct spidev_s *spi;
     uint8_t pending_flag, data_count;
     struct sensor_bulk sb;
+    struct load_cell_probe *lce;
 };
 
 // Flag types
@@ -94,6 +96,11 @@ ads1220_read_adc(struct ads1220_adc *ads1220, uint8_t oid)
     if (counts & 0x800000)
         counts |= 0xFF000000;
 
+    // endstop is optional, report if enabled and no errors
+    if (ads1220->lce) {
+        load_cell_probe_report_sample(ads1220->lce, counts);
+    }
+
     add_sample(ads1220, oid, counts);
 }
 
@@ -111,6 +118,15 @@ command_config_ads1220(uint32_t *args)
 DECL_COMMAND(command_config_ads1220, "config_ads1220 oid=%c"
     " spi_oid=%c data_ready_pin=%u");
 
+void
+ads1220_attach_load_cell_probe(uint32_t *args) {
+    uint8_t oid = args[0];
+    struct ads1220_adc *ads1220 = oid_lookup(oid, command_config_ads1220);
+    ads1220->lce = load_cell_probe_oid_lookup(args[1]);
+}
+DECL_COMMAND(ads1220_attach_load_cell_probe,
+    "ads1220_attach_load_cell_probe oid=%c load_cell_probe_oid=%c");
+
 // start/stop capturing ADC data
 void
 command_query_ads1220(uint32_t *args)