Svenska ElektronikForumet

Kod: Markera allt

/*
Poll
 */
 
//int servo=13;
//int PotValue;

// the setup routine runs once when you press reset:
void setup() {                
// initialize the digital pin as an output.
  pinMode(13, OUTPUT); 
// initialize the digital pin as an input.
// Pin 2&3 are connected to a button tied to GND with pullup 10K to VCC.
  pinMode(2, INPUT);  
  pinMode(3, INPUT);
}

int Convert_A(int Analog) {
  return 500 + 2 * Analog;
}

int Convert_D(int Digital) {
  return 500 + 2048 * Digital;
}

void runServo(int width) {
  digitalWrite(13, HIGH);
  delayMicroseconds(width);
  digitalWrite(13, LOW);
  delay(20);
}

// sensor value is converted and somehow stored to SD
int storeSensor(int AD){
  if (AD=512) return 500; // dummy
}
// holdTime value is converted and affects updating speed
int holdTime(int AD){
  if (AD=100) return 50; // dummy
}
// newUser enables new data sequence input
void newUser(){          
  int a,b;               // dummy
  a=10;
  b=a;
}
// Cal calibrates sensor to actual reference force (1kg)
void Cal(){              
  int a,b;               // dummy
  a=10;
  b=a;
}


int reg1_stat;
int reg1_dyn;
int reg2_stat;
int reg2_dyn;
int reg3_stat;
int reg3_dyn;
int reg4_stat;
int reg4_dyn;

void loop () {
  reg1_stat=analogRead(0);
  reg2_stat=analogRead(1);
  reg3_stat=digitalRead(2);
  reg4_stat=digitalRead(3);
// delays 40ms to await any knob changes.  
  delay(40); 
// abs neccesary due to sampling accuracy.  
  reg1_dyn=analogRead(0);
  if (abs(reg1_dyn-reg1_stat)>10){   
    runServo(Convert_A(reg1_dyn)); // used for debugging
    storeSensor(reg1_dyn);
  }    
  reg2_dyn=analogRead(1);
  if (abs(reg2_dyn-reg2_stat)>10){
    runServo(Convert_A(reg2_dyn)); // used for debugging
    holdTime(reg2_dyn);  
  }
  reg3_dyn=digitalRead(2);
  if (reg3_dyn != reg3_stat){
    runServo(Convert_D(reg3_dyn)); // used for debugging
    newUser();
  }
  reg4_dyn=digitalRead(3);
  if (reg4_dyn != reg4_stat){
    runServo(Convert_D(reg4_dyn)); // used for debugging
    Cal(); 
  } 
    
    
}