update
This commit is contained in:
parent
b694b5fed3
commit
284f89dc62
|
@ -5,32 +5,43 @@
|
||||||
#define __ANALOGIN_AR__ A1
|
#define __ANALOGIN_AR__ A1
|
||||||
#define __PWM_OUT__ 3
|
#define __PWM_OUT__ 3
|
||||||
|
|
||||||
float target_curent = 0;
|
float target_curent = 0.05;//ma
|
||||||
|
|
||||||
void setup()
|
void setup()
|
||||||
{
|
{
|
||||||
pinMode(__ANALOGIN_AR__,0);
|
pinMode(__ANALOGIN_AR__,0);
|
||||||
pinMode(__ANALOGIN_BR__,0);
|
pinMode(__ANALOGIN_BR__,0);
|
||||||
pinMode(__PWM_OUT__,1);
|
pinMode(__PWM_OUT__,1);
|
||||||
|
digitalWrite(__PWM_OUT__, 122);
|
||||||
Serial.begin(9600);
|
Serial.begin(9600);
|
||||||
}
|
}
|
||||||
|
|
||||||
void loop()
|
void loop()
|
||||||
{
|
{
|
||||||
static int curent;
|
static float curent;
|
||||||
static int pwm_value = 0;
|
static int pwm_value = 0;
|
||||||
curent = get_curent();
|
curent = get_curent();
|
||||||
|
Serial.println(pwm_value);
|
||||||
if(curent<target_curent*0.9)
|
if(curent<target_curent*0.9)
|
||||||
|
{
|
||||||
pwm_value++;
|
pwm_value++;
|
||||||
|
analogWrite(__PWM_OUT__, pwm_value);
|
||||||
|
}
|
||||||
else if(curent>target_curent)
|
else if(curent>target_curent)
|
||||||
|
{
|
||||||
pwm_value--;
|
pwm_value--;
|
||||||
analogWrite(__PWM_OUT__, pwm_value);
|
analogWrite(__PWM_OUT__, pwm_value);
|
||||||
|
}
|
||||||
|
delay(50);
|
||||||
}
|
}
|
||||||
|
|
||||||
float get_curent()
|
float get_curent()
|
||||||
{
|
{
|
||||||
int b = analogRead(__ANALOGIN_BR__);
|
int b = analogRead(__ANALOGIN_BR__);
|
||||||
int a = analogRead(__ANALOGIN_AR__);
|
int a = analogRead(__ANALOGIN_AR__);
|
||||||
float dv = (a-b)*(5.0/1023.0) ; //Tension réel
|
float dv = (b-a)*(5.0/1023.0) ; //Tension réel
|
||||||
return dv/(float)__RESISTOR_VALUE__;
|
float curent = (dv/(float)__RESISTOR_VALUE__)*100;
|
||||||
|
|
||||||
|
Serial.print(a);Serial.print(";");Serial.print(b);Serial.print(";");Serial.print(dv);Serial.print(";");Serial.print(curent);Serial.print(";");
|
||||||
|
return curent;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue