for (i=0;i<100;i++)
{
int cnt;
if (cnt = = 0)
{
Firstnum[0]=x;
Firstnum[1]=y;
Firstnum[2]=z;
Firstnum[3]=q4;
FIRSTNUM[4]=Q5;
}
if (cnt = = 3)
{
Midnum[0]=x;
Midnum[1]=y;
Midnum[2]=z;
Midnum[3]=q4;
MIDNUM[4]=Q5;
}
if (cnt = = 4)
{
Nextnum[0]=x;
Nextnum[1]=y;
Nextnum[2]=z;
Nextnum[3]=q4;
NEXTNUM[4]=Q5;
Pthread_rwlock_wrlock (& (Senddatatoslave.rw_lock));
SENDDATATOSLAVE.ENDPOSITIONDELTA[0]=NEXTNUM[0]-FIRSTNUM[0];
SENDDATATOSLAVE.ENDPOSITIONDELTA[1]=NEXTNUM[1]-FIRSTNUM[1];
SENDDATATOSLAVE.ENDPOSITIONDELTA[2]=NEXTNUM[2]-FIRSTNUM[2];
SENDDATATOSLAVE.ENDPOSITIONDELTA[3]=NEXTNUM[3]-FIRSTNUM[3];
SENDDATATOSLAVE.ENDPOSITIONDELTA[4]=NEXTNUM[4]-FIRSTNUM[4];
senddatatoslave.endpositiondelta[5]=0;
Senddatatoslave.endvelocitydelta[0]= (nextnum[0]-midnum[0])/T;
Senddatatoslave.endvelocitydelta[1]= (nextnum[1]-midnum[1])/T;
Senddatatoslave.endvelocitydelta[2]= (nextnum[2]-midnum[2])/T;
Senddatatoslave.endvelocitydelta[3]= (nextnum[3]-midnum[3])/T;
Senddatatoslave.endvelocitydelta[4]= (Nextnum[4]-midnum[4])/T;
senddatatoslave.endvelocitydelta[5]=0;
SENDDATATOSLAVE.ENDFORCEREF[0]=RESULT[0];
SENDDATATOSLAVE.ENDFORCEREF[1]=RESULT[1];
SENDDATATOSLAVE.ENDFORCEREF[2]=RESULT[2];
SENDDATATOSLAVE.ENDFORCEREF[3]=RESULT[3];
SENDDATATOSLAVE.ENDFORCEREF[4]=RESULT[4];
SENDDATATOSLAVE.ENDFORCEREF[5]=RESULT[5];
Data_log[0] = senddatatoslave.endpositiondelta[0];
DATA_LOG[1] = senddatatoslave.endpositiondelta[1];
DATA_LOG[2] = senddatatoslave.endpositiondelta[2];
DATA_LOG[3] = senddatatoslave.endpositiondelta[3];
DATA_LOG[4] = senddatatoslave.endpositiondelta[4];
DATA_LOG[5] = senddatatoslave.endpositiondelta[5];
DATA_LOG[6] = senddatatoslave.endvelocitydelta[0];
DATA_LOG[7] = senddatatoslave.endvelocitydelta[1];
DATA_LOG[8] = senddatatoslave.endvelocitydelta[2];
DATA_LOG[9] = senddatatoslave.endvelocitydelta[3];
DATA_LOG[10] = senddatatoslave.endvelocitydelta[4];
DATA_LOG[11] = senddatatoslave.endvelocitydelta[5];
DATA_LOG[12] = senddatatoslave.endforceref[0];
DATA_LOG[13] = senddatatoslave.endforceref[1];
DATA_LOG[14] = senddatatoslave.endforceref[2];
DATA_LOG[15] = senddatatoslave.endforceref[3];
DATA_LOG[16] = senddatatoslave.endforceref[4];
DATA_LOG[17] = senddatatoslave.endforceref[5];
Pthread_rwlock_unlock (& (Senddatatoslave.rw_lock));
CNT = 0;
}
cnt++;
}
}
The difference between each set of data in a small loop---small program