Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define MAX_FINGER 5
- typedef struct {
- byte servoValue;
- byte servoVal;
- int iFinger;
- } SERVO;
- SERVO servo[MAX_FINGER];
- const int ciDefault[] = { 200, 460};
- void setup() {
- Serial.begin(9600);
- }
- void init_default() {
- int i = 0;
- for (i = 0; i < MAX_FINGER; i++) {
- servo[i].iFinger = analogRead(i);
- if (servo[i].iFinger < ciDefault[0]) servo[i].iFinger = ciDefault[0];
- else if (servo[i].iFinger > ciDefault[1]) servo[i].iFinger = ciDefault[1];
- servo[i].servoVal = map(servo[i].iFinger, 460, 200, 255, 0);
- Serial.print(servo[i].servoVal);
- }
- }
- void loop() {
- init_default();
- delay(100);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement