110 lines
2.3 KiB
C++
110 lines
2.3 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
|
|
PontDiviseur sourceU;
|
|
PontDiviseur colecteurU;
|
|
CurentFromR baseI;
|
|
Reg regIBase;
|
|
|
|
void setup()
|
|
{
|
|
pinMode(__ANALOGIN_AR__,0);
|
|
pinMode(__ANALOGIN_BR__,0);
|
|
pinMode(__PWM_OUT__,1);
|
|
digitalWrite(__PWM_OUT__, 122);
|
|
sourceU.rapportR = 0;
|
|
sourceU.pinU = A2;
|
|
colecteurU.rapportR = 0;
|
|
colecteurU.pinU = A3;
|
|
baseI.pinU1 = A0;
|
|
baseI.pinU2 = A1;
|
|
baseI.r = 10000;
|
|
regIBase.curI = &(baseI.i);
|
|
regIBase.pinPWM = 3;
|
|
regIBase.targetI = 0.05;
|
|
Serial.begin(9600);
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
static float curent;
|
|
static int pwm_value = 0;
|
|
// curent = get_curent();
|
|
Serial.println(curent);
|
|
if(curent<target_curent*0.95)
|
|
{
|
|
pwm_value++;
|
|
analogWrite(__PWM_OUT__, pwm_value);
|
|
}
|
|
else if(curent>target_curent)
|
|
{
|
|
pwm_value--;
|
|
analogWrite(__PWM_OUT__, pwm_value);
|
|
}
|
|
delay(10);
|
|
}
|
|
|
|
/*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__)*1000;
|
|
|
|
//Serial.print(a);Serial.print(";");Serial.print(b);Serial.print(";");Serial.print(dv);Serial.print(";");Serial.print(curent);Serial.print(";");
|
|
return curent;
|
|
}
|
|
*/
|
|
float readCurentFromR(CurentFromR * data)
|
|
{
|
|
data->u1 = analogRead(data->pinU1);
|
|
data->u2 = analogRead(data->pinU2);
|
|
float dv = (data->u1-data->u2)*(5.0/1023.0) ; //Tension réel
|
|
data->i = (dv/(float)data->r)*1000;
|
|
return data->i;
|
|
}
|
|
float readUFromPontDiviseur(PontDiviseur * data)
|
|
{
|
|
data->uMesure = analogRead(data->pinU);
|
|
data->uReel = data->uMesure*data->rapportR;
|
|
return data->uReel;
|
|
}
|
|
|
|
void regulationI(Reg * reg)
|
|
{
|
|
uint16_t *ocr;
|
|
switch (reg->pinPWM) {
|
|
case 3:
|
|
ocr = &OCR2B;
|
|
break;
|
|
case 5:
|
|
ocr = &OCR0B;
|
|
break;
|
|
case 6:
|
|
ocr = &OCR0A;
|
|
break;
|
|
case 9:
|
|
ocr = &OCR1A
|
|
break;
|
|
case 10:
|
|
ocr = &OCR1B;
|
|
break;
|
|
case 11:
|
|
ocr = &OCR2A;
|
|
break;
|
|
}
|
|
if(*(reg->curI)<(reg->targetI)*0.9)
|
|
(*ocr)++
|
|
else if(*(reg->curI)>(reg->targetI))
|
|
(*ocr)--
|
|
else{
|
|
Serial.print((sourceU.uReel-colecteurU.uReel)/100);Serial.print(";");Serial.println(colecteurU);
|
|
delay(500);
|
|
}
|
|
}
|