Interface – MediaPipe hands e Arduino

O MediaPipe oferece soluções de Machine Learning personalizáveis. Com esse framework é possível implementar rapidamente uma ML para identificação de rostos, segmentação de objetos, rastreamento de mãos e poses, identificação de íris, segmentação de cabelos, entre outras infinidades de aplicações. 

Falaremos do rastreamento de mãos e dedos de alta fidelidade. Embora seja natural para as pessoas, a percepção robusta das mãos em tempo real é uma tarefa decididamente desafiadora na visão computacional, pois a mão é um membro único de cada pessoa, sendo assim não apresenta padrões de alto contraste. O MediaPipe Hands aplica um aprendizado de máquina profundo, sendo possível identificar até 21 pontos em uma mão a partir de um único quadro de imagem.

Aplicação com o MediaPipe

Neste post utilizaremos a biblioteca do MediaPipe em Python para identificar o espaçamento entre os dedos indicador e polegar por meio de uma webcam. Também criaremos uma interface para controlar o fade de um LED em tempo real através deste distanciamento dos dedos.

Materiais e montagem

Para conclusão de todo o projeto será necessário termos em mãos os seguintes materiais:

  • Arduino UNO
  • LED
  • Jumpers Macho-Macho
  • Protoboard

Bibliotecas MediaPipe e Arduino

Abra o ‘“Prompt de Comandos” do Windows, com o PIP e o Python instalados digite os seguintes comandos:

pip install mediapipe
pip install arduino-python3

Caso tenha algum problema com a instalação do MediaPipe, clique aqui para acompanhar o passo a passo de instalação do framework. Para acesso a documentação da biblioteca arduno-python3: clique aqui.

Arduino

Com a IDE do Arduino aberta faça upload da sketch que possibilita o arduino ser programado através do dispositivo que estiver conectado a ele via USB. Com este algoritmo o microcontrolador se comportará como escravo, possibilitando o controlarmos através do código em Python que será executado no computador. Para download do algoritmo clique aqui.

#include <SoftwareSerial.h>
#include <Wire.h>
#include <Servo.h>
#include <EEPROM.h>

SoftwareSerial *sserial = NULL;
Servo servos[8];
int servo_pins[] = {0, 0, 0, 0, 0, 0, 0, 0};
boolean connected = false;

int Str2int (String Str_value)
{
  char buffer[10]; //max length is three units
  Str_value.toCharArray(buffer, 10);
  int int_value = atoi(buffer);
  return int_value;
}

void split(String results[], int len, String input, char spChar) {
  String temp = input;
  for (int i=0; i<len; i++) {
    int idx = temp.indexOf(spChar);
    results[i] = temp.substring(0,idx);
    temp = temp.substring(idx+1);
  }
}

void Version(){
  Serial.println("version");
}

uint8_t readCapacitivePin(String data) {
  int pinToMeasure = Str2int(data);
  // readCapacitivePin
  //  Input: Arduino pin number
  //  Output: A number, from 0 to 17 expressing
  //  how much capacitance is on the pin
  //  When you touch the pin, or whatever you have
  //  attached to it, the number will get higher
  //  https://playground.arduino.cc/Code/CapacitiveSensor
  //
  // Variables used to translate from Arduino to AVR pin naming
  volatile uint8_t* port;
  volatile uint8_t* ddr;
  volatile uint8_t* pin;
  // Here we translate the input pin number from
  //  Arduino pin number to the AVR PORT, PIN, DDR,
  //  and which bit of those registers we care about.
  byte bitmask;
  port = portOutputRegister(digitalPinToPort(pinToMeasure));
  ddr = portModeRegister(digitalPinToPort(pinToMeasure));
  bitmask = digitalPinToBitMask(pinToMeasure);
  pin = portInputRegister(digitalPinToPort(pinToMeasure));
  // Discharge the pin first by setting it low and output
  *port &= ~(bitmask);
  *ddr  |= bitmask;
  delay(1);
  // Make the pin an input with the internal pull-up on
  *ddr &= ~(bitmask);
  *port |= bitmask;

  // Now see how long the pin to get pulled up. This manual unrolling of the loop
  // decreases the number of hardware cycles between each read of the pin,
  // thus increasing sensitivity.
  uint8_t cycles = 17;
      if (*pin & bitmask) { cycles =  0;}
  else if (*pin & bitmask) { cycles =  1;}
  else if (*pin & bitmask) { cycles =  2;}
  else if (*pin & bitmask) { cycles =  3;}
  else if (*pin & bitmask) { cycles =  4;}
  else if (*pin & bitmask) { cycles =  5;}
  else if (*pin & bitmask) { cycles =  6;}
  else if (*pin & bitmask) { cycles =  7;}
  else if (*pin & bitmask) { cycles =  8;}
  else if (*pin & bitmask) { cycles =  9;}
  else if (*pin & bitmask) { cycles = 10;}
  else if (*pin & bitmask) { cycles = 11;}
  else if (*pin & bitmask) { cycles = 12;}
  else if (*pin & bitmask) { cycles = 13;}
  else if (*pin & bitmask) { cycles = 14;}
  else if (*pin & bitmask) { cycles = 15;}
  else if (*pin & bitmask) { cycles = 16;}

  // Discharge the pin again by setting it low and output
  //  It's important to leave the pins low if you want to
  //  be able to touch more than 1 sensor at a time - if
  //  the sensor is left pulled high, when you touch
  //  two sensors, your body will transfer the charge between
  //  sensors.
  *port &= ~(bitmask);
  *ddr  |= bitmask;

  //return cycles;
  Serial.println(cycles);
}

void Tone(String data){
  int idx = data.indexOf('%');
  int len = Str2int(data.substring(0,idx));
  String data2 = data.substring(idx+1);
  int idx2 = data2.indexOf('%');
  int pin = Str2int(data2.substring(0,idx2));
  String data3 = data2.substring(idx2+1);
  String melody[len*2];
  split(melody,len*2,data3,'%');

  for (int thisNote = 0; thisNote < len; thisNote++) {
    int noteDuration = 1000/Str2int(melody[thisNote+len]);
    int note = Str2int(melody[thisNote]);
    tone(pin, note, noteDuration);
    int pause = noteDuration * 1.30;
    delay(pause);
    noTone(pin);
  }
}

void ToneNo(String data){
  int pin = Str2int(data);
  noTone(pin);
}

void DigitalHandler(int mode, String data){
      int pin = Str2int(data);
    if(mode<=0){ //read
        Serial.println(digitalRead(pin));
    }else{
        if(pin <0){
            digitalWrite(-pin,LOW);
        }else{
            digitalWrite(pin,HIGH);
        }
        //Serial.println('0');
    }
}

void AnalogHandler(int mode, String data){
    if(mode<=0){ //read
        int pin = Str2int(data);
        Serial.println(analogRead(pin));
    }else{
        String sdata[2];
        split(sdata,2,data,'%');
        int pin = Str2int(sdata[0]);
        int pv = Str2int(sdata[1]);
        analogWrite(pin,pv);
    }
}

void ConfigurePinHandler(String data){
    int pin = Str2int(data);
    if(pin <=0){
        pinMode(-pin,INPUT);
    }else{
        pinMode(pin,OUTPUT);
    }
}

void shiftOutHandler(String data) {   
    String sdata[4];
    split(sdata, 4, data, '%');
    int dataPin = sdata[0].toInt();
    int clockPin = sdata[1].toInt();
    String bitOrderName = sdata[2];
    byte value = (byte)(sdata[3].toInt());
    if (bitOrderName == "MSBFIRST") {
      shiftOut(dataPin, clockPin, MSBFIRST, value);
    } else {
      shiftOut(dataPin, clockPin, LSBFIRST, value);
    }
}

void shiftInHandler(String data) {
    String sdata[3];
    split(sdata, 3, data, '%');
    int dataPin = sdata[0].toInt();
    int clockPin = sdata[1].toInt();
    String bitOrderName = sdata[2];
    int incoming;
    if (bitOrderName == "MSBFIRST") {
      incoming = (int)shiftIn(dataPin, clockPin, MSBFIRST);
    } else {
      incoming = (int)shiftIn(dataPin, clockPin, LSBFIRST);
    }
    Serial.println(incoming);
}

void SS_set(String data){
  delete sserial;
  String sdata[3];
  split(sdata,3,data,'%');
  int rx_ = Str2int(sdata[0]);
  int tx_ = Str2int(sdata[1]);
  int baud_ = Str2int(sdata[2]);
  sserial = new SoftwareSerial(rx_, tx_);
  sserial->begin(baud_);
  Serial.println("ss OK");
}

void SS_write(String data) {
int len = data.length()+1;
char buffer[len];
data.toCharArray(buffer,len);
Serial.println("ss OK");
sserial->write(buffer);
}
void SS_read(String data) {
char c = sserial->read();
Serial.println(c);
}

void pulseInHandler(String data){
    int pin = Str2int(data);
    long duration;
    if(pin <=0){
          pinMode(-pin, INPUT);
          duration = pulseIn(-pin, LOW);     
    }else{
          pinMode(pin, INPUT);
          duration = pulseIn(pin, HIGH);     
    }
    Serial.println(duration);
}

void pulseInSHandler(String data){
    int pin = Str2int(data);
    long duration;
    if(pin <=0){
          pinMode(-pin, OUTPUT);
          digitalWrite(-pin, HIGH);
          delayMicroseconds(2);
          digitalWrite(-pin, LOW);
          delayMicroseconds(5);
          digitalWrite(-pin, HIGH);
          pinMode(-pin, INPUT);
          duration = pulseIn(-pin, LOW);     
    }else{
          pinMode(pin, OUTPUT);
          digitalWrite(pin, LOW);
          delayMicroseconds(2);
          digitalWrite(pin, HIGH);
          delayMicroseconds(5);
          digitalWrite(pin, LOW);
          pinMode(pin, INPUT);
          duration = pulseIn(pin, HIGH);     
    }
    Serial.println(duration);
}

void SV_add(String data) {
    String sdata[3];
    split(sdata,3,data,'%');
    int pin = Str2int(sdata[0]);
    int min = Str2int(sdata[1]);
    int max = Str2int(sdata[2]);
    int pos = -1;
    for (int i = 0; i<8;i++) {
        if (servo_pins[i] == pin) { //reset in place
            servos[pos].detach();
            servos[pos].attach(pin, min, max);
            servo_pins[pos] = pin;
            Serial.println(pos);
            return;
            }
        }
    for (int i = 0; i<8;i++) {
        if (servo_pins[i] == 0) {pos = i;break;} // find spot in servo array
        }
    if (pos == -1) {;} //no array position available!
    else {
        servos[pos].attach(pin, min, max);
        servo_pins[pos] = pin;
        Serial.println(pos);
        }
}

void SV_remove(String data) {
    int pos = Str2int(data);
    servos[pos].detach();
    servo_pins[pos] = 0;
}

void SV_read(String data) {
    int pos = Str2int(data);
    int angle;
    angle = servos[pos].read();
    Serial.println(angle);
}

void SV_write(String data) {
    String sdata[2];
    split(sdata,2,data,'%');
    int pos = Str2int(sdata[0]);
    int angle = Str2int(sdata[1]);
    servos[pos].write(angle);
}

void SV_write_ms(String data) {
    String sdata[2];
    split(sdata,2,data,'%');
    int pos = Str2int(sdata[0]);
    int uS = Str2int(sdata[1]);
    servos[pos].writeMicroseconds(uS);
}

void sizeEEPROM() {
    Serial.println(E2END + 1);
}

void EEPROMHandler(int mode, String data) {
    String sdata[2];
    split(sdata, 2, data, '%');
    if (mode == 0) { 
        EEPROM.write(Str2int(sdata[0]), Str2int(sdata[1])); 
    } else {
        Serial.println(EEPROM.read(Str2int(sdata[0])));
    }
}

void SerialParser(void) {
  char readChar[64];
  Serial.readBytesUntil(33,readChar,64);
  String read_ = String(readChar);
  //Serial.println(readChar);
  int idx1 = read_.indexOf('%');
  int idx2 = read_.indexOf('$');
  // separate command from associated data
  String cmd = read_.substring(1,idx1);
  String data = read_.substring(idx1+1,idx2);
 
  // determine command sent
  if (cmd == "dw") {
      DigitalHandler(1, data);  
  }
  else if (cmd == "dr") {
      DigitalHandler(0, data);  
  } 
  else if (cmd == "aw") {
      AnalogHandler(1, data);  
  }   
  else if (cmd == "ar") {
      AnalogHandler(0, data);  
  }     
  else if (cmd == "pm") {
      ConfigurePinHandler(data);  
  }   
  else if (cmd == "ps") {
      pulseInSHandler(data);  
  }   
  else if (cmd == "pi") {
      pulseInHandler(data);  
  }       
  else if (cmd == "ss") {
      SS_set(data);  
  }
  else if (cmd == "sw") {
      SS_write(data);  
  }
  else if (cmd == "sr") {
      SS_read(data);  
  }   
  else if (cmd == "sva") {
      SV_add(data);  
  }     
  else if (cmd == "svr") {
      SV_read(data);  
  }  
else if (cmd == "svw") {
      SV_write(data);  
  }   
else if (cmd == "svwm") {
      SV_write_ms(data);  
  }     
  else if (cmd == "svd") {
      SV_remove(data);  
  }
  else if (cmd == "version") {
      Version();  
  }
  else if (cmd == "to") {
      Tone(data);  
  }
  else if (cmd == "nto") {
      ToneNo(data);  
  } 
  else if (cmd == "cap") {
      readCapacitivePin(data);  
  }
  else if (cmd == "so") {
      shiftOutHandler(data);
  }
  else if (cmd == "si") {
      shiftInHandler(data);
  }
  else if (cmd == "eewr") {
      EEPROMHandler(0, data);  
  }
  else if (cmd == "eer") {
      EEPROMHandler(1, data);  
  } 
  else if (cmd == "sz") { 
      sizeEEPROM();
  } 
}

void setup()  {
  Serial.begin(9600);
    while (!Serial) {
    ; // wait for serial port to connect. Needed for Leonardo only
  }
}

void loop() {
  SerialParser();
  }

Python

Nesta etapa iremos criar uma interface entre o framework, o Arduino e a webcam do nosso computador. Para isso é necessário importar as bibliotecas e criar o setup inicial. É extremamente importante que o parâmetro “port” contenha a porta em que o seu Arduino está conectado. Então para que seu algoritmo seja executado de maneira adequada faça a alteração da porta de acordo com a sua opção.

import cv2
import mediapipe as mp
import time
from Arduino import Arduino

mp_drawing = mp.solutions.drawing_utils
mp_hands = mp.solutions.hands

board = Arduino("9600", port="COM5") 
board.pinMode(9, "OUTPUT")

Criamos uma função para remapear um número de um intervalo para outro. Isto é, valores dentro de uma faixa para valores dentro de outra faixa.

def _map(x, in_min, in_max, out_min, out_max):
    return int((x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min)

Em seguida é feita toda a configuração para execução do framework com a webcam. Para mais informações sobre funções, parâmetros e acesso a documentação do MediaPipe Hands, clique aqui.

with mp_hands.Hands(
    min_detection_confidence=0.5,
    min_tracking_confidence=0.5) as hands:
  while cap.isOpened():
    success, image = cap.read()
    if not success:
      print("Ignoring empty camera frame.")
      continue

    image = cv2.cvtColor(cv2.flip(image, 1), cv2.COLOR_BGR2RGB)
    image.flags.writeable = False
    results = hands.process(image)

    image.flags.writeable = True
    image = cv2.cvtColor(image, cv2.COLOR_RGB2BGR)
    image_hight, image_width, _ = image.shape

Agora é necessário fazer toda manipulação para reconhecer a distância entre o dedo polegar e o indicador. Para isso rastreamos a posição do ponto 4. THUMB_TIP e do ponto 8. INDEX_FINGER_TIP. Em seguida criamos um vetor que contém o distanciamento destes os pontos representados em coordenadas (x,y).

Para manipular o fade do Led consideramos necessário trabalhar apenas com a coordenada x, pois ela imprime a distância no eixo das abcissas entre o polegar e o indicador. O fade do Led é controlado através de PWM, sendo assim é necessário adequar os valores da escala da coordenada x para a escala de duty cycle do PWM do Arduino, para isto utilizamos a função _map criada no início do algoritmo. Por fim, este valor é impresso no pino 9 do arduino onde está o LED.   

 if results.multi_hand_landmarks:

      #print(results.multi_handedness) # esquerda ou direita
      for hand_landmarks in results.multi_hand_landmarks:
      # Coordenadas do indicador e do polegar
          indicador_x = hand_landmarks.landmark[mp_hands.HandLandmark.INDEX_FINGER_TIP].x * image_width
          indicador_y = hand_landmarks.landmark[mp_hands.HandLandmark.INDEX_FINGER_TIP].y * image_hight

          polegar_x = hand_landmarks.landmark[mp_hands.HandLandmark.THUMB_TIP].x * image_width
          polegar_y = hand_landmarks.landmark[mp_hands.HandLandmark.THUMB_TIP].y * image_hight

          fade = (abs(indicador_x - polegar_x), abs(indicador_y - polegar_y))
          print(fade[0])
          x = _map(fade[0], 30, 210, 0, 255)
          board.analogWrite(9, x)


      for hand_landmarks in results.multi_hand_landmarks:
        mp_drawing.draw_landmarks(
            image, hand_landmarks, mp_hands.HAND_CONNECTIONS)
    cv2.imshow('MediaPipe Hands', image)
    if cv2.waitKey(5) & 0xFF == 27:
      break
cap.release()

Para finalizar, abriremos uma janela de visualização no computador. Para download do algoritmo completo clique aqui. Crie um arquivo “hands.py” e cole o código baixado, feito isso abra o terminal de comando e execute o arquivo com o Arduino conectado através da porta USB.

import cv2
import mediapipe as mp
import time
from Arduino import Arduino

mp_drawing = mp.solutions.drawing_utils
mp_hands = mp.solutions.hands

board = Arduino("9600", port="COM5") 
board.pinMode(9, "OUTPUT")
cap = cv2.VideoCapture(0)

def _map(x, in_min, in_max, out_min, out_max):
    return int((x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min)


with mp_hands.Hands(
    min_detection_confidence=0.5,
    min_tracking_confidence=0.5) as hands:
  while cap.isOpened():
    success, image = cap.read()
    if not success:
      print("Ignoring empty camera frame.")
      continue

    image = cv2.cvtColor(cv2.flip(image, 1), cv2.COLOR_BGR2RGB)
    image.flags.writeable = False
    results = hands.process(image)

    image.flags.writeable = True
    image = cv2.cvtColor(image, cv2.COLOR_RGB2BGR)
    image_hight, image_width, _ = image.shape
   
    if results.multi_hand_landmarks:

      #print(results.multi_handedness) # esquerda ou direita
      for hand_landmarks in results.multi_hand_landmarks:
      # Coordenadas do indicador e do polegar
          indicador_x = hand_landmarks.landmark[mp_hands.HandLandmark.INDEX_FINGER_TIP].x * image_width
          indicador_y = hand_landmarks.landmark[mp_hands.HandLandmark.INDEX_FINGER_TIP].y * image_hight

          polegar_x = hand_landmarks.landmark[mp_hands.HandLandmark.THUMB_TIP].x * image_width
          polegar_y = hand_landmarks.landmark[mp_hands.HandLandmark.THUMB_TIP].y * image_hight

          fade = (abs(indicador_x - polegar_x), abs(indicador_y - polegar_y))
          print(fade[0])
          x = _map(fade[0], 30, 210, 0, 255)
          board.analogWrite(9, x)


      for hand_landmarks in results.multi_hand_landmarks:
        mp_drawing.draw_landmarks(
            image, hand_landmarks, mp_hands.HAND_CONNECTIONS)
    cv2.imshow('MediaPipe Hands', image)
    if cv2.waitKey(5) & 0xFF == 27:
      break
cap.release()

Conclusão

Se todos os procedimentos foram executados de maneira correta ao aproximarmos o polegar do indicador o Led apagará e quanto maior for a distância entre os dois dedos, maior será a intensidade luminosa do LED. Neste post foi apresentado apenas uma interface de comunicação entre o framework de aprendizado de máquina MediaPipe e o microcontrolador Arduino. Fique a vontade para fazer aplicações com novas funcionalidades. O MediaPipe oferece uma vasta gama de ferramentas de aprendizado de máquina.

Licença Creative Commons Esta obra está licenciada com uma Licença Creative Commons Atribuição-CompartilhaIgual 4.0 Internacional.
Comentários:
Notificações
Notificar
1 Comentário
recentes
antigos mais votados
Inline Feedbacks
View all comments
HEITTOR FELIPE COSTA
HEITTOR FELIPE COSTA
11/05/2021 16:15

Muito top, parabéns !

Home » Arduino » Interface – MediaPipe hands e Arduino

EM DESTAQUE

WEBINARS

VEJA TAMBÉM

JUNTE-SE HOJE À COMUNIDADE EMBARCADOS

Talvez você goste: