52 lines
958 B
C++
52 lines
958 B
C++
#include <Servo.h>
|
|
|
|
Servo serv;
|
|
|
|
int pin = A0; //input Velostat pin
|
|
int pinServo = 9; //servo pin
|
|
|
|
float sensorVal;
|
|
float voltage;
|
|
float voltageCal;
|
|
float voltageScale;
|
|
float angle;
|
|
float Weight;
|
|
|
|
//Calibration
|
|
float offset = 2.585;
|
|
float scale = -0.0008;
|
|
float bias = 11;
|
|
|
|
void setup() {
|
|
Serial.begin(9600);
|
|
serv.attach(pinServo); //attach servo pin
|
|
pinMode(pin,INPUT_PULLUP);
|
|
digitalWrite(pin, HIGH);
|
|
}
|
|
|
|
void loop() {
|
|
sensorVal = analogRead(pin);
|
|
voltage = sensorVal * (5.0 / 1023.0);
|
|
|
|
//voltageCal = voltage - bias;
|
|
//voltageScale = abs(voltageCal / scale);
|
|
//voltageScale = (scale*voltageCal)-offset;
|
|
|
|
angle = voltage*54.54;
|
|
//angle = map(voltage,0,3.3,0,180);
|
|
//Weight = (voltage-offset)/scale;
|
|
|
|
//Serial Printing
|
|
Serial.print(sensorVal);
|
|
Serial.print(" , ");
|
|
Serial.print(voltage);
|
|
Serial.print(" , ");
|
|
Serial.print(Weight);
|
|
Serial.print(" , ");
|
|
Serial.println(angle);
|
|
|
|
|
|
serv.write(angle);
|
|
delay(500);
|
|
}
|