1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
|
# Utility for querying the current state of adc pins
#
# Copyright (C) 2019 Kevin O'Connor <kevin@koconnor.net>
#
# This file may be distributed under the terms of the GNU GPLv3 license.
class QueryADC:
def __init__(self, config):
self.printer = config.get_printer()
self.adc = {}
gcode = self.printer.lookup_object("gcode")
gcode.register_command(
"QUERY_ADC", self.cmd_QUERY_ADC, desc=self.cmd_QUERY_ADC_help
)
def register_adc(self, name, mcu_adc):
self.adc[name] = mcu_adc
cmd_QUERY_ADC_help = "Report the last value of an analog pin"
def cmd_QUERY_ADC(self, gcmd):
name = gcmd.get("NAME", None)
if name not in self.adc:
objs = ['"%s"' % (n,) for n in sorted(self.adc.keys())]
msg = "Available ADC objects: %s" % (", ".join(objs),)
gcmd.respond_info(msg)
return
value, timestamp = self.adc[name].get_last_value()
msg = 'ADC object "%s" has value %.6f (timestamp %.3f)' % (
name,
value,
timestamp,
)
pullup = gcmd.get_float("PULLUP", None, above=0.0)
if pullup is not None:
v = max(0.00001, min(0.99999, value))
r = pullup * v / (1.0 - v)
msg += "\n resistance %.3f (with %.0f pullup)" % (r, pullup)
gcmd.respond_info(msg)
def load_config(config):
return QueryADC(config)
|
