Add M3426 A<addr> parameter (#24130)

Co-authored-by: Scott Lahteine <github@thinkyhead.com>
This commit is contained in:
Stephen Hawes
2022-05-05 03:37:47 -04:00
committed by Scott Lahteine
parent 54e543872b
commit 995221e68e
3 changed files with 14 additions and 12 deletions

View File

@ -28,6 +28,8 @@
#include "../../../feature/adc/adc_mcp3426.h"
#define MCP3426_BASE_ADDR (0b1101 << 3)
/**
* M3426: Read 16 bit (signed) value from I2C MCP3426 ADC device
*
@ -36,12 +38,15 @@
* M3426 I<byte-2 value in base 10> 0 or 1, invert reply
*/
void GcodeSuite::M3426() {
uint8_t channel = parser.byteval('C', 1), // Select the channel 1 or 2
gain = parser.byteval('G', 1);
const bool inverted = parser.byteval('I') == 1;
uint8_t channel = parser.byteval('C', 1), // Channel 1 or 2
gain = parser.byteval('G', 1), // Gain 1, 2, 4, or 8
address = parser.byteval('A', 3); // Address 0-7 (or 104-111)
const bool inverted = parser.boolval('I');
if (channel <= 2 && (gain == 1 || gain == 2 || gain == 4 || gain == 8)) {
int16_t result = mcp3426.ReadValue(channel, gain);
if (address <= 7) address += MCP3426_BASE_ADDR;
if (WITHIN(channel, 1, 2) && (gain == 1 || gain == 2 || gain == 4 || gain == 8) && WITHIN(address, MCP3426_BASE_ADDR, MCP3426_BASE_ADDR + 7)) {
int16_t result = mcp3426.ReadValue(channel, gain, address);
if (mcp3426.Error == false) {
if (inverted) {