48 lines
1.0 KiB
C++
48 lines
1.0 KiB
C++
#include "RegulationIntensite.h"
|
|
|
|
#define __RESISTOR_VALUE__ 10000
|
|
#define __ANALOGIN_BR__ A0
|
|
#define __ANALOGIN_AR__ A1
|
|
#define __PWM_OUT__ 3
|
|
|
|
float target_curent = 0.05;//ma
|
|
|
|
void setup()
|
|
{
|
|
pinMode(__ANALOGIN_AR__,0);
|
|
pinMode(__ANALOGIN_BR__,0);
|
|
pinMode(__PWM_OUT__,1);
|
|
digitalWrite(__PWM_OUT__, 122);
|
|
Serial.begin(9600);
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
static float curent;
|
|
static int pwm_value = 0;
|
|
curent = get_curent();
|
|
Serial.println(pwm_value);
|
|
if(curent<target_curent*0.9)
|
|
{
|
|
pwm_value++;
|
|
analogWrite(__PWM_OUT__, pwm_value);
|
|
}
|
|
else if(curent>target_curent)
|
|
{
|
|
pwm_value--;
|
|
analogWrite(__PWM_OUT__, pwm_value);
|
|
}
|
|
delay(50);
|
|
}
|
|
|
|
float get_curent()
|
|
{
|
|
int b = analogRead(__ANALOGIN_BR__);
|
|
int a = analogRead(__ANALOGIN_AR__);
|
|
float dv = (b-a)*(5.0/1023.0) ; //Tension réel
|
|
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;
|
|
}
|