Program using the Touch Sensor and a Servo

Dependencies:   Servo TSI mbed

main.cpp

Committer:
icarobrito
Date:
2014-11-12
Revision:
0:b831c26b9a46

File content as of revision 0:b831c26b9a46:

/*Programa para acionamento de um servomotor
O servo motor funciona de 90º a -90º
Neste programa é feita a leitura do touch e é utilizada para a posição do servomotor
*/
#include "mbed.h"
#include "Servo.h"
#include "TSISensor.h"

TSISensor touch; //declarando o objeto do touch
Servo servo(PTE29); //declarando o objeto do servomotor e o pino



  int main() {
    float a=0;
    servo.Enable(1000,20000);
    while(1){
          a=touch.readPercentage();
          a=a*1000+1000;       //Fórmula para equiparar as escalas do servomotor e do sensor touch
          servo.SetPosition(a);  
          wait(1);
      
 
      
    }
 }