Advertisement
Guest User

other code

a guest
Nov 7th, 2012
46
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.65 KB | None | 0 0
  1. #define MAX_FINGER 5
  2. typedef struct {
  3. byte servoValue;
  4. byte servoVal;
  5. int iFinger;
  6. } SERVO;
  7.  
  8. SERVO servo[MAX_FINGER];
  9. const int ciDefault[] = { 200, 460};
  10.  
  11. void setup() {
  12. Serial.begin(9600);
  13. }
  14. void init_default() {
  15. int i = 0;
  16. for (i = 0; i < MAX_FINGER; i++) {
  17. servo[i].iFinger = analogRead(i);
  18. if (servo[i].iFinger < ciDefault[0]) servo[i].iFinger = ciDefault[0];
  19. else if (servo[i].iFinger > ciDefault[1]) servo[i].iFinger = ciDefault[1];
  20. servo[i].servoVal = map(servo[i].iFinger, 460, 200, 255, 0);
  21. Serial.print(servo[i].servoVal);
  22. }
  23. }
  24.  
  25. void loop() {
  26. init_default();
  27. delay(100);
  28. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement