Diff: embedded/MATH1.cpp

Revision:

2:bfc676294e38

Parent:

1:c6b089f4ff2a

Child:

3:1823bfc913c1

diff -r c6b089f4ff2a -r bfc676294e38 embedded/MATH1.cpp
--- a/embedded/MATH1.cpp	Tue Jan 10 08:25:27 2017 +0000
+++ b/embedded/MATH1.cpp	Wed Jan 18 11:19:53 2017 +0000
@@ -1,5 +1,14 @@
 #include "MATH1.h"
 #define pi  3.14159265359
+double round(double src, int n)
+{
+    double res;
+    int i, k = 1;
+    for (i = 0; i<n; i++)k *= 10;
+    res = int(src*k + 0.5);
+    res /= k;
+    return res;
+}
 double mean(double *d, int len)
 {
     double mean = 0.0;
@@ -55,7 +64,32 @@
     return rms;
 }
 
-
+///Voltage Deviation Factor///
+double MATH::VDF(double d1, double d2, double d3)
+{
+    double dmax=0.0;
+    double x[3]={fabs((d1-220)/220)*100,fabs((d2-220)/220)*100,fabs((d3-220)/220)*100};
+    for(int i=0 ; i<3 ; i++) {
+        if(x[i]>dmax) {
+            dmax=x[i];
+        }
+    }
+    return dmax;
+}
+///Currrent Deviation Factor///
+double MATH::CDF(double d1, double d2, double d3)
+{
+    double dmax=0.0;
+    double x[3]={d1,d2,d3};
+    for(int i=0 ; i<3 ; i++) {
+        if(x[i]>dmax) {
+            dmax=x[i];
+        }
+    }
+    double CDF=(dmax-6.1)/6.1*100;
+    if(CDF<0){CDF=0;}
+    return CDF;
+}        
 ///unbalance rate///
 double MATH::UR(double d1, double d2, double d3)
 {
@@ -224,7 +258,7 @@
         }
         if(fabs(y[i]) > ymax) {
             ymax = fabs(y[i]);
-        }
+        } 
         if(fabs(z[i]) > zmax) {
             zmax = fabs(z[i]);
         }
@@ -271,19 +305,21 @@
 double MATH::THD(double *ass_1, double *ass_2, double *ass_3, int pu)
 {
     double WTF, WTFa, WTFb, WTFc;
-    double you_1, you_2, you_3, fu_1, fu_2, fu_3;
+    double you_1=0, you_2=0, you_3=0, fu_1, fu_2, fu_3;
+    int i=0;
 
     switch(pu) {
         case 10000 :
-            you_1  = (sqr(ass_1[120]) + sqr(ass_1[180]) + sqr(ass_1[240]) + sqr(ass_1[300]) + sqr(ass_1[360]) + sqr(ass_1[420]) + sqr(ass_1[480]) + sqr(ass_1[540]) + sqr(ass_1[600]) + sqr(ass_1[660]));
+        
+            for(i=0;i<10;i++){you_1  = you_1+sqr(ass_1[120+i*60]);} 
             fu_1 = sqrt(you_1);
             WTFa  = (fu_1 / ass_1[60])*100;
 
-            you_2  = (sqr(ass_2[120]) + sqr(ass_2[180]) + sqr(ass_2[240]) + sqr(ass_2[300]) + sqr(ass_2[360]) + sqr(ass_2[420]) + sqr(ass_2[480]) + sqr(ass_2[540]) + sqr(ass_2[600]) + sqr(ass_2[660]));
+            for(i=0;i<10;i++){you_2  = you_2+sqr(ass_2[120+i*60]);} 
             fu_2 = sqrt(you_2);
             WTFb  = (fu_2 / ass_2[60])*100;
 
-            you_3  = (sqr(ass_3[120]) + sqr(ass_3[180]) + sqr(ass_3[240]) + sqr(ass_3[300]) + sqr(ass_3[360]) + sqr(ass_3[420]) + sqr(ass_3[480]) + sqr(ass_3[540]) + sqr(ass_3[600]) + sqr(ass_3[660]));
+            for(i=0;i<10;i++){you_3  = you_3+sqr(ass_3[120+i*60]);} 
             fu_3 = sqrt(you_3);
             WTFc  = (fu_3 / ass_3[60])*100;
 
@@ -362,12 +398,12 @@
             su_11 = (ck_1[660] / ck_1[60])*100;
 
             blow1 = su_3;
-            double job[4]= {su_5, su_7, su_9, su_11};
-            for(int i = 0 ; i<4 ; i++) {
-                if(job[i] > blow1) {
-                    blow1 = job[i];
-                }
-            }
+            //double job[4]= {su_5, su_7, su_9, su_11};
+            //for(int i = 0 ; i<4 ; i++) {
+            //    if(job[i] > blow1) {
+            //        blow1 = job[i];
+            //    }
+            //}
 
             su_3 = (ck_2[180] / ck_2[60])*100;
             su_5 = (ck_2[300] / ck_2[60])*100;
@@ -376,12 +412,12 @@
             su_11 = (ck_2[660] / ck_2[60])*100;
 
             blow2 = su_3;
-            double job2[4]= {su_5, su_7, su_9, su_11};
-            for(int i = 0 ; i<4 ; i++) {
-                if(job2[i] > blow2) {
-                    blow2 = job2[i];
-                }
-            }
+            //double job2[4]= {su_5, su_7, su_9, su_11};
+            //for(int i = 0 ; i<4 ; i++) {
+            //    if(job2[i] > blow2) {
+            //        blow2 = job2[i];
+            //    }
+            //}
 
             su_3 = (ck_3[180] / ck_3[60])*100;
             su_5 = (ck_3[300] / ck_3[60])*100;
@@ -390,12 +426,12 @@
             su_11 = (ck_3[660] / ck_3[60])*100;
 
             blow3 = su_3;
-            double job3[4]= {su_5, su_7, su_9, su_11};
-            for(int i = 0 ; i<4 ; i++) {
-                if(job3[i] > blow3) {
-                    blow3 = job3[i];
-                }
-            }
+            //double job3[4]= {su_5, su_7, su_9, su_11};
+            //for(int i = 0 ; i<4 ; i++) {
+            //    if(job3[i] > blow3) {
+            //        blow3 = job3[i];
+            //    }
+            //}
 
             blow = MAXof3(blow1, blow2, blow3);
 
@@ -477,3 +513,178 @@
     return blow;
 
 }
+double MATH::BB(double *d1, double *d2, double *d3, int pu)
+{
+   switch(pu){
+      case 10000:
+   
+          double x[3]={d1[59], d1[60], d1[61]}, y[3]={d2[59], d2[60], d2[61]}, z[3]={d3[59], d3[60], d3[61]};
+          double x_1[3]={d1[65], d1[66], d1[67]}, y_1[3]={d2[65], d2[66], d2[67]}, z_1[3]={d3[65], d3[66], d3[67]};
+          double x_2[3]={d1[53], d1[54], d1[55]}, y_2[3]={d2[53], d2[54], d2[55]}, z_2[3]={d3[53], d3[54], d3[55]};
+          int i=0;double tmp1=0,tmp2=0,tmp3=0,tmp1_1=0,tmp2_1=0,tmp3_1=0,tmp1_2=0,tmp2_2=0,tmp3_2=0;
+          for(i=0;i<3;i++){if(x[i]>tmp1)tmp1=x[i];}
+          for(i=0;i<3;i++){if(y[i]>tmp2)tmp2=y[i];}
+          for(i=0;i<3;i++){if(z[i]>tmp3)tmp3=z[i];}
+          for(i=0;i<3;i++){if(x_1[i]>tmp1_1)tmp1_1=x_1[i];}
+          for(i=0;i<3;i++){if(y_1[i]>tmp2_1)tmp2_1=y_1[i];}
+          for(i=0;i<3;i++){if(z_1[i]>tmp3_1)tmp3_1=z_1[i];}
+          for(i=0;i<3;i++){if(x_2[i]>tmp1_2)tmp1_2=x_2[i];}
+          for(i=0;i<3;i++){if(y_2[i]>tmp2_2)tmp2_2=y_2[i];}
+          for(i=0;i<3;i++){if(z_2[i]>tmp3_2)tmp3_2=z_2[i];}
+          double n[3],ra=0,rb=0,rc=0,la=0,lb=0,lc=0,BB=-50;
+          for(i=0;i<2;i++){n[i]=x_1[i]-x_1[i+1];if(n[i]<ra)ra=n[i];}
+          for(i=0;i<2;i++){n[i]=y_1[i]-y_1[i+1];if(n[i]<rb)rb=n[i];}
+          for(i=0;i<2;i++){n[i]=z_1[i]-z_1[i+1];if(n[i]<rc)rc=n[i];}
+          for(i=0;i<2;i++){n[i]=x_2[i+1]-x_2[i];if(n[i]<la)la=n[i];}
+          for(i=0;i<2;i++){n[i]=y_2[i+1]-y_2[i];if(n[i]<lb)lb=n[i];}
+          for(i=0;i<2;i++){n[i]=z_2[i+1]-z_2[i];if(n[i]<lc)lc=n[i];}
+          if(ra<-0.02 || la<-0.02){n[0]=20*log10((tmp1_1+tmp1_2)/tmp1);} else {n[0]=-50;}
+          if(rb<-0.02 || lb<-0.02){n[1]=20*log10((tmp2_1+tmp2_2)/tmp2);} else {n[1]=-50;}
+          if(rc<-0.02 || lc<-0.02){n[2]=20*log10((tmp3_1+tmp3_2)/tmp3);} else {n[2]=-50;}
+          for(i=0;i<3;i++){if(n[i]>BB)BB=n[i];}
+          return BB;
+   
+          break;
+        case 8192:
+   
+          double xx[3]={d1[23], d1[24], d1[25]}, yy[3]={d2[23], d2[24], d2[25]}, zz[3]={d3[23], d3[24], d3[25]};
+          double xx_1[3]={d1[25], d1[26], d1[27]}, yy_1[3]={d2[25], d2[26], d2[27]}, zz_1[3]={d3[25], d3[26], d3[27]};
+          double xx_2[3]={d1[21], d1[22], d1[23]}, yy_2[3]={d2[21], d2[22], d2[23]}, zz_2[3]={d3[21], d3[22], d3[23]};
+          double ttmp1=0,ttmp2=0,ttmp3=0,ttmp1_1=0,ttmp2_1=0,ttmp3_1=0,ttmp1_2=0,ttmp2_2=0,ttmp3_2=0;
+          for(i=0;i<3;i++){if(xx[i]>ttmp1)ttmp1=xx[i];}
+          for(i=0;i<3;i++){if(yy[i]>ttmp2)ttmp2=yy[i];}
+          for(i=0;i<3;i++){if(zz[i]>ttmp3)ttmp3=zz[i];}
+          for(i=0;i<3;i++){if(xx_1[i]>ttmp1_1)ttmp1_1=xx_1[i];}
+          for(i=0;i<3;i++){if(yy_1[i]>ttmp2_1)ttmp2_1=yy_1[i];}
+          for(i=0;i<3;i++){if(zz_1[i]>ttmp3_1)ttmp3_1=zz_1[i];}
+          for(i=0;i<3;i++){if(xx_2[i]>ttmp1_2)ttmp1_2=xx_2[i];}
+          for(i=0;i<3;i++){if(yy_2[i]>ttmp2_2)ttmp2_2=yy_2[i];}
+          for(i=0;i<3;i++){if(zz_2[i]>ttmp3_2)ttmp3_2=zz_2[i];}
+          double nn[3],rra=0,rrb=0,rrc=0,lla=0,llb=0,llc=0,BBB=-50;
+          for(i=0;i<3;i++){nn[i]=xx_1[i]-xx_1[i+1];if(nn[i]<rra)rra=nn[i];}
+          for(i=0;i<3;i++){nn[i]=yy_1[i]-yy_1[i+1];if(nn[i]<rrb)rrb=nn[i];}
+          for(i=0;i<3;i++){nn[i]=zz_1[i]-zz_1[i+1];if(nn[i]<rrc)rrc=nn[i];}
+          for(i=0;i<3;i++){nn[i]=xx_2[i+1]-xx_2[i];if(nn[i]<lla)lla=nn[i];}
+          for(i=0;i<3;i++){nn[i]=yy_2[i+1]-yy_2[i];if(nn[i]<llb)llb=nn[i];}
+          for(i=0;i<3;i++){nn[i]=zz_2[i+1]-zz_2[i];if(nn[i]<llc)llc=nn[i];}
+          if(rra<-0.02 || lla<-0.02){nn[0]=20*log10((ttmp1_1+ttmp1_2)/ttmp1);} else {nn[0]=-50;}
+          if(rrb<-0.02 || llb<-0.02){nn[1]=20*log10((ttmp2_1+ttmp2_2)/ttmp2);} else {nn[1]=-50;}
+          if(rrc<-0.02 || llc<-0.02){nn[2]=20*log10((ttmp3_1+ttmp3_2)/ttmp3);} else {nn[2]=-50;}
+          for(i=0;i<3;i++){if(nn[i]>BB)BB=nn[i];}
+          return BB;
+         break;
+   }
+}
+void MATH::Fuzzy_Fault(double IUR,double IUF,double THDV,double VDFodd,double THDI,double IDFodd,double BB,double peakvalue,double *health,double *stator,double *rotor,double *bearing, double *eccentric)
+{  
+   double h[8],f1[8],s[7],r[7],b[6],e[6],h1max=0,f1max=0,g1max=0,g2max=0,rmax=0,bmax=0,smax=0,emax=0; int i=0;
+   h[0]=IUR*1.0/8.0-1.0/4.0;if(h[0]<0){h[0]=0;}if(h[0]>1){h[0]=1;}
+   h[1]=IUF*2.0-4.0;if(h[1]<0){h[1]=0;}if(h[1]>1){h[1]=1;}
+   h[2]=THDV*(1.0/3.0)-2.0/3.0;if(h[2]<0){h[2]=0;}if(h[2]>1){h[2]=1;}
+   h[3]=VDFodd*2.0/5.0-1.0/5.0;if(h[3]<0){h[3]=0;}if(h[3]>1){h[3]=1;}
+   h[4]=THDI*2.0/5.0-1.0;if(h[4]<0){h[4]=0;}if(h[4]>1){h[4]=1;}
+   h[5]=IDFodd*1.0/3.0-1.0/3.0;if(h[5]<0){h[5]=0;}if(h[5]>1){h[5]=1;}
+   h[6]=BB*1.0/5.0+9.0;if(h[6]<0){h[6]=0;}if(h[6]>1){h[6]=1;}
+   h[7]=peakvalue*2.0-8.0;if(h[7]<0){h[7]=0;}if(h[7]>1){h[7]=1;}
+   if(h[0]==0&&h[1]==0&&h[2]==0&&h[3]==0&&h[4]==0&&h[5]==0&&h[6]==0&&h[7]==0){*health=100;*stator=0;*rotor=0;*bearing=0;*eccentric=0;}
+   else{
+   for(i=0;i<8;i++){f1[i]=h[i];if(h[i]>f1max){f1max=h[i];}}
+   h1max=1-f1max;
+   *health=h1max*100;
+   g2max=h[7];g1max=1-g2max;
+   s[0]=h[0]*0.987*0.6;r[0]=h[0]*0.013*0.6;s[1]=h[1];r[1]=0;s[2]=h[2]*0.242*0.6;r[2]=h[2]*0.758*0.6;s[3]=h[3]*0.24*0.6;r[3]=h[3]*0.76*0.6;s[4]=h[4]*0.383*0.6;r[4]=h[4]*0.617*0.6;s[5]=h[5]*0.44*0.6;r[5]=h[5]*0.56*0.6;
+   r[6]=h[6];s[6]=0;if(r[6]==0){s[6]=1.0;}
+   for(i=0;i<7;i++){if(s[i]>smax){smax=s[i];}if(r[i]>rmax)rmax=r[i];}
+   rmax=rmax/(smax+rmax);smax=1-rmax;*stator=f1max*g1max*smax*100;*rotor=f1max*g1max*rmax*100;
+   b[0]=h[0]*0.025*0.6;e[0]=h[0]*0.975*0.6;b[1]=0;e[1]=h[1];b[2]=h[2]*0.797*0.6;e[2]=h[2]*0.203*0.6;b[3]=h[3]*0.839*0.6;e[3]=h[3]*0.161*0.6;b[4]=h[4]*0.722*0.6;e[4]=h[4]*0.278*0.6;b[5]=h[5]*0.764*0.6;e[5]=h[5]*0.236*0.6;
+   for(i=0;i<6;i++){if(b[i]>bmax){bmax=b[i];}if(e[i]>emax)emax=e[i];}
+   emax=emax/(bmax+emax);bmax=1-emax;*bearing=f1max*g2max*bmax*100;*eccentric=f1max*g2max*emax*100;
+   }
+}   
+void MATH::Fuzzy_Condition(double VUR,double IUR,double VUF,double IUF,double THDV,double VDFodd,double THDI,double IDFodd,double VD,double CD,double Vel,double Dis,double *pCMS)
+{
+  double g1[2],g2[2],g3[2],g4[2],g5[2],g6[2],g7[2],g8[2],g9[2],c1[9]={0},c2[9]={0},p[2];
+  int flag1,flag2,flag3,flag4,flag5,flag6,flag7,flag8,flag9,i;
+  if(VUR>=5||IUR>=10||THDV>=5||VDFodd>=3||THDI>=5||IDFodd>=4||VD>=10||CD>=10||Vel>=4.5||VUF>=1||IUF>=2.5||Dis>=90){*pCMS=1;}
+  else if(VUR<=1&&IUR<=2&&THDV<=1.5&&VDFodd<=1.5&&THDI<=2.5&&IDFodd<=2&&VD<=2.5&&CD==0&&Vel<=0.7){*pCMS=0;}
+  else{
+        if(VUR<=2){g1[1]=VUR-1.0;if(g1[1]<0){g1[1]=0;}g1[0]=1-g1[1];flag1=1;}
+        if(VUR>2&&VUR<=3.5){g1[1]=VUR*2.0/3.0-4.0/3.0;g1[0]=1-g1[1];flag1=2;}
+        if(VUR>3.5&&VUR<5){g1[1]=VUR*2.0/3.0-7.0/3.0;g1[0]=1-g1[1];flag1=3;}
+        if(IUR<=4){g2[1]=IUR*0.5-1;if(g2[1]<0){g2[1]=0;}g2[0]=1-g2[1];flag2=1;}
+        if(IUR>4&&IUR<=6){g2[1]=IUR*0.5-2.0;g2[0]=1-g2[1];flag2=2;}
+        if(IUR>6&&IUR<10){g2[1]=IUR*0.25-3.0*2.0;g2[0]=1-g2[1];flag2=3;}
+        if(THDV<=2){g3[1]=THDV*2-3;if(g3[1]<0){g3[1]=0;}g3[0]=1-g3[1];flag3=1;}
+        if(THDV>2&&THDV<=3.5){g3[1]=THDV*2.0/3.0-4.0/3.0;g3[0]=1-g3[1];flag3=2;}
+        if(THDV>3.5&&THDV<5){g3[1]=THDV*2.0/3.0-7.0/3.0;g3[0]=1-g3[1];flag3=3;}
+        if(VDFodd<=2){g3[1]=VDFodd*2.0-3.0;if(g4[1]<0){g4[1]=0;}g4[0]=1-g4[1];flag4=1;}
+        if(VDFodd>2&&VDFodd<=2.5){g4[1]=VDFodd*2.0-4.0;g4[0]=1-g4[1];flag4=2;}
+        if(VDFodd>2.5&&VDFodd<3){g4[1]=VDFodd*2.0-5.0;g4[0]=1-g4[1];flag4=3;}
+        if(THDI<=3){g5[1]=THDI*2.0-5.0;if(g5[1]<0){g5[1]=0;}g5[0]=1-g5[1];flag5=1;}
+        if(THDI>3&&THDI<=4){g5[1]=THDI-3.0;g5[0]=1-g5[1];flag5=2;}
+        if(THDI>4&&THDI<5){g5[1]=THDI-4.0;g5[0]=1-g5[1];flag5=3;}
+        if(IDFodd<=2.5){g6[1]=IDFodd*2.0-4.0;if(g6[1]<0){g6[1]=0;}g6[0]=1-g6[1];flag6=1;}
+        if(IDFodd>2.5&&IDFodd<=3){g6[1]=IDFodd*2.0-5.0;g6[0]=1-g6[1];flag6=2;}
+        if(IDFodd>3&&IDFodd<4){g6[1]=IDFodd-3.0;g6[0]=1-g6[1];flag6=3;}
+        if(VD<=3){g7[1]=VD*2.0-5.0;if(g7[1]<0){g7[1]=0;}g7[0]=1-g7[1];flag7=1;}
+        if(VD>3&&VD<=5){g7[1]=VD*0.5-3.0/2.0;g7[0]=1-g7[1];flag7=2;}
+        if(VD>5&&VD<10){g7[1]=VD*0.2-1.0;g7[0]=1-g7[1];flag7=3;}
+        if(CD<=2){g8[1]=CD*0.5;if(g8[1]<0){g8[1]=0;}g8[0]=1-g8[1];flag8=1;}
+        if(CD>2&&CD<=5){g8[1]=CD*1.0/3.0-2.0/3.0;g8[0]=1-g8[1];flag8=2;}
+        if(CD>5&&CD<10){g8[1]=CD*0.2-1.0;g8[0]=1-g8[1];flag8=3;}
+        if(Vel<=0.7){g9[1]=Vel*10.0/7.0;if(g9[1]<0){g9[1]=0;}g9[0]=1-g9[1];flag9=1;}
+        if(Vel>0.7&&Vel<=1.8){g9[1]=Vel*10.0/11.0-7.0/11.0;g9[0]=1-g9[1];flag9=2;}
+        if(Vel>1.8&&Vel<4.5){g9[1]=Vel*10.0/27.0-2.0/3.0;g9[0]=1-g9[1];flag9=3;}
+        if(flag1==3||flag2==3||flag3==3||flag4==3||flag5==3||flag6==3||flag7==3||flag8==3||flag9==3){
+            if(flag1==3){c1[0]=g1[0];c2[0]=g1[1];}
+            if(flag2==3){c1[1]=g2[0];c2[1]=g2[1];}
+            if(flag3==3){c1[2]=g3[0];c2[2]=g3[1];}
+            if(flag4==3){c1[3]=g4[0];c2[3]=g4[1];}
+            if(flag5==3){c1[4]=g5[0];c2[4]=g5[1];}
+            if(flag6==3){c1[5]=g6[0];c2[5]=g6[1];}
+            if(flag7==3){c1[6]=g7[0];c2[6]=g7[1];}
+            if(flag8==3){c1[7]=g8[0];c2[7]=g8[1];}
+            if(flag9==3){c1[8]=g9[0];c2[8]=g9[1];}
+            p[0]=c1[0];p[1]=c2[0];
+            for(i=1;i<9;i++){
+                if(p[0]<c1[i]){p[0]=c1[i];}
+                if(p[1]<c2[i]){p[1]=c2[i];}                
+            }
+            *pCMS=(p[0]*0.6667+p[1])/(p[0]+p[1]);
+        }
+        else if(flag1==2||flag2==2||flag3==2||flag4==2||flag5==2||flag6==2||flag7==2||flag8==2||flag9==2){
+             if(flag1==2){c1[0]=g1[0];c2[0]=g1[1];}
+             if(flag2==2){c1[1]=g2[0];c2[1]=g2[1];}
+             if(flag3==2){c1[2]=g3[0];c2[2]=g3[1];}
+             if(flag4==2){c1[3]=g4[0];c2[3]=g4[1];}
+             if(flag5==2){c1[4]=g5[0];c2[4]=g5[1];}
+             if(flag6==2){c1[5]=g6[0];c2[5]=g6[1];}
+             if(flag7==2){c1[6]=g7[0];c2[6]=g7[1];}
+             if(flag8==2){c1[7]=g8[0];c2[7]=g8[1];}
+             if(flag9==2){c1[8]=g9[0];c2[8]=g9[1];}
+             p[0]=c1[0];p[1]=c2[0];
+             for(i=1;i<9;i++){
+                if(p[0]<c1[i]){p[0]=c1[i];}
+                if(p[1]<c2[i]){p[1]=c2[i];}                
+             }
+             *pCMS=(p[0]*0.3333+p[1]*0.6667)/(p[0]+p[1]);
+        }
+        else{
+             if(flag1==1){c1[0]=g1[0];c2[0]=g1[1];}
+             if(flag2==1){c1[1]=g2[0];c2[1]=g2[1];}
+             if(flag3==1){c1[2]=g3[0];c2[2]=g3[1];}
+             if(flag4==1){c1[3]=g4[0];c2[3]=g4[1];}
+             if(flag5==1){c1[4]=g5[0];c2[4]=g5[1];}
+             if(flag6==1){c1[5]=g6[0];c2[5]=g6[1];}
+             if(flag7==1){c1[6]=g7[0];c2[6]=g7[1];}
+             if(flag8==1){c1[7]=g8[0];c2[7]=g8[1];}
+             if(flag9==1){c1[8]=g9[0];c2[8]=g9[1];}
+             p[0]=c1[0];p[1]=c2[0];
+             for(i=1;i<9;i++){
+                if(p[0]<c1[i]){p[0]=c1[i];}
+                if(p[1]<c2[i]){p[1]=c2[i];}                
+             }
+             *pCMS=(p[1]*0.3333)/(p[0]+p[1]);
+        }
+  }                  
+}
\ No newline at end of file