@Rolfdegen: I think you meant "damaged" rather than "defective" on your Teensy4 modules. You wouldn't want a future reader to get the wrong impression...the T4s were working fine when you received them.
#include <Arduino.h>
#include <ResponsiveAnalogRead.h>
// 74HC4067 Analog Multiplexer for Pots
int PotSel_1 = 2;
int PotSel_2 = 3;
int PotSel_3 = 4;
int PotSel_4 = 5;
// define the pin you want to use
const int ANALOG_PIN = A0;
// make a ResponsiveAnalogRead object, pass in the pin, and either true or false depending on if you want sleep enabled
// enabling sleep will cause values to take less time to stop changing and potentially stop changing more abruptly,
// where as disabling sleep will cause values to ease into their correct position smoothly and more accurately
ResponsiveAnalogRead analog(ANALOG_PIN, true);
ResponsiveAnalogRead analog1(ANALOG_PIN, true);
// Setup -------------------------------------------------------
void setup()
{
// init PotSel 74HC4067 Analog Multiplexer
pinMode(PotSel_1, OUTPUT);
pinMode(PotSel_2, OUTPUT);
pinMode(PotSel_3, OUTPUT);
pinMode(PotSel_4, OUTPUT);
digitalWrite(PotSel_1, LOW);
digitalWrite(PotSel_2, LOW);
digitalWrite(PotSel_3, LOW);
digitalWrite(PotSel_4, LOW);
// init ADC Input for Pots
analogReadResolution(10);
analog.setAnalogResolution(1024);
}
// read Pots ---------------------------------------------------
void read_Pot()
{
if (readPot_Timer > 5)
{
readPot_Timer = 0;
// select Pot
digitalWrite(PotSel_1, LOW);
digitalWrite(PotSel_2, LOW);
digitalWrite(PotSel_3, LOW);
digitalWrite(PotSel_4, LOW);
// read channel 1
analog.update();
// read channel 2
digitalWrite(PotSel_1, HIGH);
analog1.update();
if (analog.hasChanged() && analog1.hasChanged())
{
int value_A = analog.getValue(); // value_A 0 - 1022
int value_B = analog1.getValue(); // value_B 0 - 1022
Serial.print(value_A);
Serial.print(" ");
Serial.print(value_B);
Serial.print(" ");
// Compute current angle and dial position
double fx = ((double)value_A / 511.5) - 1; // range -1 to +1
double fy = ((double)value_B / 511.5) - 1;
double angle = atan2(fx, fy)/PI; // range -pi to +pi
Serial.println(angle);
//int dialPosition = map(angle, -PI, PI, 0, 128);
}
}
}
// Loop ---------------------------------------------------
void loop()
{
read_Pot();// read Pots ---------------------------------------------------
void read_Pot()
{
if (readPot_Timer > 5)
{
readPot_Timer = 0;
// select Pot
digitalWrite(PotSel_1, LOW);
digitalWrite(PotSel_2, LOW);
digitalWrite(PotSel_3, LOW);
digitalWrite(PotSel_4, LOW);
// read channel 1
analog.update();
// read channel 2
digitalWrite(PotSel_1, HIGH);
analog1.update();
if (analog.hasChanged() && analog1.hasChanged())
{
int value_A = analog.getValue(); // value_A 0 - 1022
int value_B = analog1.getValue(); // value_B 0 - 1022
Serial.print(value_A);
Serial.print(" ");
Serial.print(value_B);
Serial.print(" ");
// Compute current angle and dial position
double fx = ((double)value_A / 511.5) - 1; // range -1 to +1
double fy = ((double)value_B / 511.5) - 1;
double angle = atan2(fx, fy); // range -pi to +pi
Serial.print(angle);
Serial.print(" ");
int StartPos = 0;
int EndPos = 127;
int dialPosition = map(angle, -PI, PI, StartPos, EndPos);
Serial.println(dialPosition);
}
}
}
#include <ResponsiveAnalogRead.h>
// 74HC4067 Analog Multiplexer for Pots
int PotSel_1 = 2;
int PotSel_2 = 3;
int PotSel_3 = 4;
int PotSel_4 = 5;
int analogReadVal_A = 0;
int analogReadVal_B = 0;
int analogRead_prevVal = 0;
int prevValue = -1;
int potValue = 0;
boolean analogReadUpdate_A = false;
boolean analogReadUpdate_B = false;
// define the pin you want to use
const int ANALOG_PIN = A0;
// make a ResponsiveAnalogRead object, pass in the pin, and either true or false depending on if you want sleep enabled
// enabling sleep will cause values to take less time to stop changing and potentially stop changing more abruptly,
// where as disabling sleep will cause values to ease into their correct position smoothly and more accurately
ResponsiveAnalogRead analog1(ANALOG_PIN, true);
ResponsiveAnalogRead analog2(ANALOG_PIN, true);
// read 360° endless Pots --------------------------------------
void read_Pot()
{
if (readPot_Timer > 21) // 21ms
{
readPot_Timer = 0;
// Select two analog inputs on 74HC4067 multiplexer
digitalWrite(PotSel_1, LOW);
digitalWrite(PotSel_2, HIGH);
digitalWrite(PotSel_3, LOW);
digitalWrite(PotSel_4, HIGH);
analog1.update();
digitalWrite(PotSel_1, HIGH);
digitalWrite(PotSel_2, HIGH);
digitalWrite(PotSel_3, LOW);
digitalWrite(PotSel_4, HIGH);
analog2.update();
// if analog inputs change than calc potValue
if (analog1.hasChanged() && analogReadUpdate_A == false)
{
analogReadVal_A = analog1.getValue(); // value_A 0 - 1023
analogReadUpdate_A = true;
{
if (analog1.hasChanged() && analogReadUpdate_B == false)
{
analogReadVal_B = analog2.getValue(); // value_B 0 - 1023
analogReadUpdate_B = true;
{
if (analogReadUpdate_A == true && analogReadUpdate_B == true)
{
// Compute current angle and dial position
double fx = ((double)analogReadVal_A / 511.5) - 1; // range -1 to +1
double fy = ((double)analogReadVal_B / 511.5) - 1;
double angle = atan2(fx, fy); // range -pi to +pi
int newValue = (angle + M_PI) * (float)1023 / (2.0 * M_PI);
int delta = 0;
int Pot_ID = 1;
// calc delta and steps for potValue
delta = (newValue - prevValue);
if (delta > 511 || delta < -511)
{
delta = 0;
}
potValue += delta;
if (potValue < 0)
{
potValue = 0;
}
else if (potValue > 1023)
{
potValue = 1023;
}
// save current potValue and call Pot handle
if (encoder_last_value[Mixer_menu][Pot_ID] != potValue)
{
Pot_handle(Pot_ID, potValue);
encoder_last_value[Mixer_menu][Pot_ID] = potValue;
}
// save previous potValue
prevValue = newValue;
// clear update flags
analogReadUpdate_A = false;
analogReadUpdate_B = false;
}
}
}
}
}
}
}