//HABILITADOR DE LA SEÑAL DE SALIDA
bool ENABLE = false;
#define LED_ENABLE 15
//DESFASE DE LAS SEÑALES
int phase[6]={0,0,0,0,0,0};
//NUMERO DE MUESTRAS DE LA SEÑAL
#define NUM_SAMPLES 256
//SEÑALES DE SALIDA
#define PIN_VA 36
#define PIN_IA 39
#define PIN_VB 35
#define PIN_IB 32
#define PIN_VC 25
#define PIN_IC 26
//MUESTRA DE LA SEÑAL SINUSOIDAL
uint8_t sinedata[NUM_SAMPLES] = {
128, 131, 134, 137, 140, 143, 146, 149, 152, 155, 158, 162, 165, 167, 170, 173,
176, 179, 182, 185, 188, 190, 193, 196, 198, 201, 203, 206, 208, 211, 213, 215,
218, 220, 222, 224, 226, 228, 230, 232, 234, 235, 237, 238, 240, 241, 243, 244,
245, 246, 248, 249, 250, 250, 251, 252, 253, 253, 254, 254, 254, 255, 255, 255,
255, 255, 255, 255, 254, 254, 254, 253, 253, 252, 251, 250, 250, 249, 248, 246,
245, 244, 243, 241, 240, 238, 237, 235, 234, 232, 230, 228, 226, 224, 222, 220,
218, 215, 213, 211, 208, 206, 203, 201, 198, 196, 193, 190, 188, 185, 182, 179,
176, 173, 170, 167, 165, 162, 158, 155, 152, 149, 146, 143, 140, 137, 134, 131,
128, 124, 121, 118, 115, 112, 109, 106, 103, 100, 97, 93, 90, 88, 85, 82,
79, 76, 73, 70, 67, 65, 62, 59, 57, 54, 52, 49, 47, 44, 42, 40,
37, 35, 33, 31, 29, 27, 25, 23, 21, 20, 18, 17, 15, 14, 12, 11,
10, 9, 7, 6, 5, 5, 4, 3, 2, 2, 1, 1, 1, 0, 0, 0,
0, 0, 0, 0, 1, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 9,
10, 11, 12, 14, 15, 17, 18, 20, 21, 23, 25, 27, 29, 31, 33, 35,
37, 40, 42, 44, 47, 49, 52, 54, 57, 59, 62, 65, 67, 70, 73, 76,
79, 82, 85, 88, 90, 93, 97, 100, 103, 106, 109, 112, 115, 118, 121, 124};
//DEFINICION DE LA SEÑALES DE SALIDA
uint8_t sinewaves[6][NUM_SAMPLES];
//FRECUENCIA DE MUESTREO
#define BASE_FREQ_MULT 128
#define SAMPLE_RATE (NUM_SAMPLES*BASE_FREQ_MULT)
//RESOLUCIÓN Y FRECUENCIA DE LOS PULSOS PWM (8 BITS / 313111 Hz)
#define PWM_RESOLUTION 8
#define PWM_FREQUENCY 313111
//CONFIGURACIÓN DEL TIMER
#define TIMER_FREQ 10000000 // 1MHz * 10
#define TIMER_RATE 305 // (1/(SAMPLE RATE)) 30.5uS * 10
//CONFIGURACION DE LA FRECUENCIA
#define FREQ2INC(f) (f*2)
uint16_t acc;
uint16_t inc;
//----------/----------/----------/----------/----------/----------/----------/----------/----------/
//----------| DECLARACIÓN DE FUNCIONES |----------
//INICIAR LAS SEÑALES DE SALIDA
void start(){
for( int j=0; j<6; j++){
for(int i=0; i<NUM_SAMPLES;i++){
sinewaves[j][i]=sinedata[i];
}
}
}
//ROTAR LA MUESTRA DE LA SEÑAL
void rotate_array(uint8_t *arr, int d, int n){
uint8_t temp[n];
//ROTAR A LA DERECHA (ADELANTO)
if(d>0){
for(int i=0; i<d; i++){
temp[i]=arr[i+(n-d)];
}
for(int i=0;i<(n-d);i++){
temp[i+d]=arr[i];
}
}
//ROTAR A LA IZQUIERDA (RETRASO)
else if(d<0){
d=-d;
for(int i=0; i<(n-d); i++){
temp[i]=arr[i+d];
}
for(int i=0; i<+d; i++){
temp[i+(n-d)]=arr[i];
}
}
for(int i=0; i<n; i++){
arr[i]=temp[i];
}
}
//ENVIAR EL ANGULO Y EL PRIMER ELEMENTO DE LA MUESTRA DE LA SEÑAL
void print_phase(){
Serial.println((String)
" ∠VA: "+phase[0]+":"+sinewaves[0][0]+
" ∠VB: "+phase[1]+":"+sinewaves[1][0]+
" ∠VC: "+phase[2]+":"+sinewaves[2][0]+
" ∠IA: "+phase[3]+":"+sinewaves[3][0]+
" ∠IB: "+phase[4]+":"+sinewaves[4][0]+
" ∠IC: "+phase[5]+":"+sinewaves[5][0]
);
Serial.println("Listo!");
}
//PROCESAMIENTO DE MENSAJES RECIBIDOS EN EL PUERTO SERIAL
void serial_message(){
//DEFINICION DEL BUFFER DE LA COMUNICACION SERIAL
#define BUFFER_SIZE 26
char buffer[BUFFER_SIZE];
if (Serial.available()>0){
int command = Serial.readBytesUntil('\n',buffer, BUFFER_SIZE);
switch(buffer[0]){
//COMANDO 'X': HABILITAR O DESHABILITAR LA SEÑAL DE SALIDA
case 'X':
ENABLE = !ENABLE;
ENABLE ? (digitalWrite(LED_ENABLE, HIGH)) : (digitalWrite(LED_ENABLE, LOW));
Serial.println((String)"SALIDA: "+(ENABLE ? "ON" : "OFF"));
Serial.println("Listo!");
break;
//COMANDO 'Y': DESFASAR LAS SEÑALES DE SALIDA
case 'Y':
ENABLE = false;
digitalWrite(LED_ENABLE, LOW);
start();
for(int j=0; j<6; j++){
char temp[4];
for(int i=0; i<4; i++){
temp[i] = buffer[i+4*j+1];
}
phase[j] = atoi(temp);
}
for(int i=0; i<6; i++){
if(phase[i]!=0){
rotate_array(sinewaves[i],phase[i],NUM_SAMPLES);
}
}
print_phase();
ENABLE = true;
digitalWrite(LED_ENABLE, HIGH);
break;
//COMANDO 'Z': MOSTRAR EL DESFASE ACTUAL
case 'Z':
print_phase();
break;
default:
Serial.println("Comando invalido");
}
}
}
void setFreq (unsigned freq) {
inc = FREQ2INC(freq);
Serial.print("Freq: ");
Serial.print(freq);
Serial.print("\tIncrement: ");
Serial.println(inc);
}
void ddsUpdate (void) {
if(ENABLE == true){
acc += inc;
ledcWrite (PIN_VA, sinewaves[0][acc >> 8]);
ledcWrite (PIN_VB, sinewaves[1][acc >> 8]);
ledcWrite (PIN_VC, sinewaves[2][acc >> 8]);
ledcWrite (PIN_IA, sinewaves[3][acc >> 8]);
ledcWrite (PIN_IB, sinewaves[4][acc >> 8]);
ledcWrite (PIN_IC, sinewaves[5][acc >> 8]);
}else{
ledcWrite (PIN_VA, 0);
ledcWrite (PIN_VB, 0);
ledcWrite (PIN_VC, 0);
ledcWrite (PIN_IA, 0);
ledcWrite (PIN_IB, 0);
ledcWrite (PIN_IC, 0);
}
;
}
hw_timer_t *timer = NULL;
int toggle;
void ARDUINO_ISR_ATTR timerIsr (void) {
#ifdef TIMING_PIN
toggle = !toggle;
digitalWrite(TIMING_PIN, toggle);
#endif
ddsUpdate();
}
void setup(){
start();
Serial.begin(115200);
pinMode(LED_ENABLE, OUTPUT);
#ifdef TIMING_PIN
pinMode(TIMING_PIN, OUTPUT);
digitalWrite(TIMING_PIN, LOW);
#endif
timer = timerBegin(TIMER_FREQ);
timerAttachInterrupt(timer, &timerIsr);
timerAlarm(timer, TIMER_RATE, true, 0);
Serial.print("Timer frequency: ");
Serial.println(timerGetFrequency(timer));
ledcAttach(PIN_VA, PWM_FREQUENCY, PWM_RESOLUTION);
ledcAttach(PIN_VB, PWM_FREQUENCY, PWM_RESOLUTION);
ledcAttach(PIN_VC, PWM_FREQUENCY, PWM_RESOLUTION);
ledcAttach(PIN_IA, PWM_FREQUENCY, PWM_RESOLUTION);
ledcAttach(PIN_IB, PWM_FREQUENCY, PWM_RESOLUTION);
ledcAttach(PIN_IC, PWM_FREQUENCY, PWM_RESOLUTION);
setFreq(60);
}
void loop(){
serial_message();
}