arduino/esp8266
1
0
Fork 0
mirror of https://github.com/esp8266/Arduino.git synced 2025-06-20 21:01:25 +03:00
Code Activity

Robot Control library to format 1.5 rev.2

Browse Source
This commit is contained in:
Cristian Maglie
2014-01-01 23:45:39 +01:00
parent a80b2b1d53
commit 03a7cf3212
48 changed files with 2 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

65
libraries/Robot_Control/src/keyboard.cpp Normal file
View File

@ -0,0 +1,65 @@
#include "ArduinoRobot.h"
#if ARDUINO >= 100
#include "Arduino.h"
#else
#include "WProgram.h"
#endif
int pul_min[]={0,133,319,494,732};
int pul_max[]={10,153,339,514,752};
/*int pul_min[]={0,123,295,471,714};
int pul_max[]={0,143,315,491,734};*/
/*
int pul_min[]={0,133,319,494,732};
int pul_max[]={10,153,339,514,752};
*/
void sort(int* v);
void RobotControl::keyboardCalibrate(int *vals){
for(int i=0;i<5;i++){
pul_min[i]=vals[i]-10;
pul_max[i]=vals[i]+10;
}
}
int8_t RobotControl::keyboardRead(void)
{
int lectura_pul;
int8_t conta_pul=0;
static int anterior=0;
lectura_pul = this->averageAnalogInput(KEY);
while ((conta_pul < NUMBER_BUTTONS) && !(lectura_pul >= pul_min[conta_pul] && lectura_pul <= pul_max[conta_pul]))
conta_pul++;
if (conta_pul >= NUMBER_BUTTONS)
conta_pul = -1;
else
delay(100);
return conta_pul;
}
int RobotControl::averageAnalogInput(int pinNum)
{
int vals[5];
for(int i=0;i<5;i++){
for(int j=i;j<5;j++){
vals[j]=::analogRead(pinNum);
}
sort(vals);
}
return vals[0];
}
void sort(int* v){
int tmp;
for(int i=0;i<4;i++)
for(int j=i+1;j<5;j++)
if(v[j]<v[i]){
tmp=v[j];
v[j]=v[i];
v[i]=tmp;
}
v[0]=v[3];
}