EMG controlled servo

Hello

I am trying to control 5 servo motors with the DFRobot EMG sensor. I have connected them to the PMW outputs with a separate power supply on the Arduino Uno R3.

My approach was to rewrite the simple EMG filter sketch so that the servomotors turn from 0 to 180 degrees when I tense the muscle, but they either don't move at all or just tremble.

Can anyone help me?

Here is my scetch:

#include <Arduino.h>
#include <EMGFilters.h>
#include <Servo.h>

#define _DEBUG      0

#define SensorInputPin A0 // input pin number

// Define the `CALIBRATE` macro as 1 to calibrate the baseline value
// of input sEMG signals.
//
// After wiring the sEMG sensors to the Arduino board, wear the
// sEMG sensors. Relax your muscles for a few seconds, you
// will be able to see a series of squared sEMG signals values get printed on
// your serial terminal. Choose the maximal one as the baseline by setting
// the `baseline` variable.
//
// After calibriting, change the `CALIBRATE` macro to 0, and rebuild this
// project. The `envelope`, which is the squared sEMG signal data, will be
// printed to the serial line. The developer can plot it using the Arduino
// SerialPlotter.
//
// Note:
//      After calibration, Any squared value of sEMG sigal below the
//      baseline will be treated as zero.
//
//      It is recommended that you do calibration every time you wear
//      the sEMG sensor.
#define CALIBRATE 1

int baseline = 200;

EMGFilters myFilter;

// Set the input frequency.
//
// The filters work only with fixed sample frequency of
// `SAMPLE_FREQ_500HZ` or `SAMPLE_FREQ_1000HZ`.
// Inputs at other sample rates will bypass
SAMPLE_FREQUENCY sampleRate = SAMPLE_FREQ_1000HZ;

// Time interval for processing the input signal.
unsigned long long interval = 1000000ul / sampleRate;

// Set the frequency of power line hum to filter out.
//
// For countries with 60Hz power line, change to "NOTCH_FREQ_60HZ"
NOTCH_FREQUENCY humFreq = NOTCH_FREQ_50HZ;

Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
Servo servo5;

void setup() {
   /* add setup code here */
   myFilter.init(sampleRate, humFreq, true, true, true);
   Serial.begin(115200);
   servo1.attach(3); // Pin 3 for servo 1
   servo2.attach(5); // Pin 5 for servo 2
   servo3.attach(6); // Pin 6 for servo 3
   servo4.attach(9); // Pin 9 for servo 4
   servo5.attach(10); // Pin 10 for servo 5
}

void loop() {
   // Note: `micros()` will overflow and reset every about 70 minutes.
   unsigned long long timeStamp = micros();

   int data = analogRead(SensorInputPin);

   // filter processing
   int dataAfterFilter = myFilter.update(data);

   // Get envelope by squaring the input
   int envelope = sq(dataAfterFilter);

   if (CALIBRATE) {
       Serial.print("Squared Data: ");
       Serial.println(envelope);
   } else {
       // Any value below the `baseline` value will be treated as zero
       if (envelope < baseline) {
           dataAfterFilter = 0;
           envelope = 0;
           // Set servo angles to 0 if the envelope is below baseline
           servo1.write(0);
           servo2.write(0);
    servo3.write(0);
    servo4.write(0);
    servo5.write(0);
       } else {
           // Set servo angles to 180 if the envelope is above baseline
           servo1.write(180);
           servo2.write(180);
           servo3.write(180);
           servo4.write(180);
           servo5.write(180);
       }
       // You may plot the data using Arduino SerialPlotter.
       Serial.print(envelope);
   }

   // Usually, you should still have (interval - timeElapsed) to do other work.
   // Otherwise, you would have to lower down the `sampleRate`.
   unsigned long long timeElapsed = micros() - timeStamp;
#if _DEBUG
   Serial.print("Filters cost time: ");
   Serial.println(timeElapsed);
#else
   delay((interval - timeElapsed) / 1000);
#endif
}