Controlling 3 servo motors with 3 fsrs

[hk_jh]

I would like to control 3 MG995 servo motors with 3 FSR.
if sensor is fully press the servo will be at 90 degree. if fsr is not press the servo will be at 0 degree.

It is the first time I'm working with servo motors. I am not sure my code is the best for what want. Any advice?

project wired as follow:

here is my code:

#define NUM_INPUTS 2

#include <Servo.h>

const byte SIG_pins[] = { A0, A1, A2 };
int heartbeatLED = 13;

const byte filter = 3;  //adjust as needed

const byte pressThreshold = 10;

int lastValue[NUM_INPUTS];
bool muxIsOn[NUM_INPUTS];

Servo servos[NUM_INPUTS];

// define servo pins
const byte servoPins[] = { 9, 10, 11 };

//timing variables
unsigned long previousMillis = 0;
unsigned long heartbeatMillis;

unsigned long interval = 20;

// servo angles for each FSR
int servoAngles[] = { 0, 0, 0 };


//********************************************^************************************************
void setup() {
  Serial.begin(115200);

  pinMode(heartbeatLED, OUTPUT);

  for (byte i = 0; i < NUM_INPUTS; i++) {
    pinMode(SIG_pins[i], INPUT);
    servos[i].attach(servoPins[i]); // attach servo to corresponding pin
  }
}

void loop() {
  unsigned long currentMillis = millis();
  if (currentMillis - previousMillis >= interval) {
    previousMillis = currentMillis;
    readValues();
    checkHeartbeatTIMER();
    controlServos();
  }
}


//// functions ////



void readValues() {
  for (byte i = 0; i < NUM_INPUTS; i++) {
    //read the stabilized analog
   int SensorValue = 1023 - analogRead(SIG_pins[i]);

    //has analog value changed more than the filter amount ?
    if (abs(lastValue[i] - SensorValue) > filter) {
      if (lastValue[i] != SensorValue) {
        //update to the new value
        lastValue[i] = SensorValue;
        Serial.print("sensor");
        Serial.print(i + 1);
        Serial.print(" ");
        Serial.println(SensorValue);

        // check if FSR is pressed or not
        if (SensorValue >= pressThreshold) {
          int servoAngle = map(SensorValue, pressThreshold, 1023, 0, 90);
          servoAngles[i] = servoAngle;
          Serial.print("ch");
          Serial.print(i + 1);
          Serial.print(" servo angle: ");
          Serial.println(servoAngle);
        } else {
          servoAngles[i] = 0;
        }
      }
    }
  }
}

void controlServos() {
  for (byte i = 0; i < NUM_INPUTS; i++) {
    servos[i].write(servoAngles[i]);
  }
}

void checkHeartbeatTIMER() {
  //*********************************                                heartbeat TIMER
  //is it time to toggle the heartbeatLED ?
  if (millis() - heartbeatMillis >= 500ul) {
    //restart this TIMER
    heartbeatMillis = millis();

    //toggle the heartbeatLED
    digitalWrite(heartbeatLED, !digitalRead(heartbeatLED));
  }

}  //END of   checkHeartbeatTIMER()

[Railroader]

There are Servo and Servo motors. Find out the difference. I think that MG995 is a servo.
Learn how to read buttons safely.
Then learn how to move a servo.
When thise two steos are done and work You can start to connect button readings and servo moves.

[hk_jh]

I'm not sure I understand what you are saying. I'm not even use buttons.
I can't move a servo as I am doing in my code? I guess that should be some slope of few ms between value to value of the servo?

[anon56112670]

@hk_jh

pinMode(SIG_pins[i], INPUT);

You're using analogue input pins as analogue inputs; it is not necessary to set the pinMode.

What problem do you perceive with the code?
What do the debug prints tell you?

[Railroader]

@hk_jh

I'm not even use buttons.

My mistake answering from the cell phone. Change "buttons" to FSR! The You get a reasonable reply.

EDIT: Updating the servo every 20 mS looks very fast, too fast, to me.
Does this build do anything? Looks quite okey, assuming You have powered things properly. You have show from where Vcc comes. It needs to be capable of delivering some Amps.
Usually digital pins are used...