電流のフィードバック制御
Posted: 2011年12月08日(木) 17:14
#include <math.h>
#include <stdio.h>
__declspec(dllexport) void simuser (t, delt, in, out)
double t, delt;
double *in, *out;
{
static double f1=10000,f2=60,v=0,n=0,h=0,c=0,x1=0,x2=0,s=0,im=0;
double vout=0,k1,k2,vs,vtri,vt,pai=3.14,rad,vsin,i,j,k3,k4,va,vs1=0,vs2=0,iout,ts=0.0000025;
三角波
vtri=2;
k1=1/delt;
k2=(k1/f1)/2;
vs=vtri/k2;
h=h+1;
if(h<=k2){
v=v+vs;
}else if(h>=k2){
v=v-vs;
}else{
v=v;
}
if(h>=(k2*2)){
h=0;
}
vt=v-(vtri/2);
正弦波
j=90;
k3=1/delt;
k4=(k3/f2)/4;
i=j/k4;
n=n+i;
rad=(pai*n)/180;
vsin=sin(rad);
スイッチ制御1
if(vsin<vt){
x1=x1+delt;
if(x1>=ts){
vs1=1;
}else if(x1<ts){
vs1=0;
}else{
x1=x1;
}
}else if(vsin>vt){
vs1=0;
x1=0;
}else{
vs1=vs1;
}
スイッチ制御2
if(vsin<vt){
vs2=0;
x2=0;
}else if(vsin>vt){
x2=x2+delt;
if(x2>=ts){
vs2=1;
}else if(x2<ts){
vs2=0;
}else{
x2=x2;
}
}else{
vs2=vs2;
}
フィードバック 制御 ここが上手くいきません。
iout=in[0];
im=1.5;
if(im<iout){
vsin=vsin*0.09;
}else if(im>iout){
vsin=vsin*1.01;
}else if(im=iout){
vsin=vsin;
}
out[0]=vs1;
out[1]=vs2;
out[2]=vt;
out[3]=vsin;
}
このプログラムは三角波と正弦波を使って、二つを比較し、vs1、vs2が交互にオンオフしてその結果ioutに値が出力されます。
分からないのが、その出力された値をフィードバックして目標値に近づけるプログラムです。
まず値を制御するためにはvsinを増減することでioutの値を変えることができます。なのでioutをフィードバックし、目標値と比べ、大きければ0.09をかけ小さければ1.01をかけてやればいいと思ったのですが上手くいきません。
c言語は初心者なので全然わかりません。良ければ教えていただけませんか?
#include <stdio.h>
__declspec(dllexport) void simuser (t, delt, in, out)
double t, delt;
double *in, *out;
{
static double f1=10000,f2=60,v=0,n=0,h=0,c=0,x1=0,x2=0,s=0,im=0;
double vout=0,k1,k2,vs,vtri,vt,pai=3.14,rad,vsin,i,j,k3,k4,va,vs1=0,vs2=0,iout,ts=0.0000025;
三角波
vtri=2;
k1=1/delt;
k2=(k1/f1)/2;
vs=vtri/k2;
h=h+1;
if(h<=k2){
v=v+vs;
}else if(h>=k2){
v=v-vs;
}else{
v=v;
}
if(h>=(k2*2)){
h=0;
}
vt=v-(vtri/2);
正弦波
j=90;
k3=1/delt;
k4=(k3/f2)/4;
i=j/k4;
n=n+i;
rad=(pai*n)/180;
vsin=sin(rad);
スイッチ制御1
if(vsin<vt){
x1=x1+delt;
if(x1>=ts){
vs1=1;
}else if(x1<ts){
vs1=0;
}else{
x1=x1;
}
}else if(vsin>vt){
vs1=0;
x1=0;
}else{
vs1=vs1;
}
スイッチ制御2
if(vsin<vt){
vs2=0;
x2=0;
}else if(vsin>vt){
x2=x2+delt;
if(x2>=ts){
vs2=1;
}else if(x2<ts){
vs2=0;
}else{
x2=x2;
}
}else{
vs2=vs2;
}
フィードバック 制御 ここが上手くいきません。
iout=in[0];
im=1.5;
if(im<iout){
vsin=vsin*0.09;
}else if(im>iout){
vsin=vsin*1.01;
}else if(im=iout){
vsin=vsin;
}
out[0]=vs1;
out[1]=vs2;
out[2]=vt;
out[3]=vsin;
}
このプログラムは三角波と正弦波を使って、二つを比較し、vs1、vs2が交互にオンオフしてその結果ioutに値が出力されます。
分からないのが、その出力された値をフィードバックして目標値に近づけるプログラムです。
まず値を制御するためにはvsinを増減することでioutの値を変えることができます。なのでioutをフィードバックし、目標値と比べ、大きければ0.09をかけ小さければ1.01をかけてやればいいと思ったのですが上手くいきません。
c言語は初心者なので全然わかりません。良ければ教えていただけませんか?