mirror of
https://github.com/slsdetectorgroup/slsDetectorPackage.git
synced 2025-06-13 05:17:13 +02:00
almost done
This commit is contained in:
@ -43,11 +43,15 @@ unsigned int Feb_Control_triggerMode; //internal timer, external start,
|
||||
unsigned int Feb_Control_externalEnableMode; //external enabling engaged and it's polarity
|
||||
unsigned int Feb_Control_subFrameMode;
|
||||
|
||||
|
||||
unsigned int Feb_Control_nimages;
|
||||
double Feb_Control_exposure_time_in_sec;
|
||||
int Feb_Control_subframe_exposure_time_in_10nsec;
|
||||
double Feb_Control_exposure_period_in_sec;
|
||||
|
||||
int Feb_Control_RateTable_Tau_in_nsec = -1;
|
||||
int Feb_Control_RateTable_Subexptime_in_nsec = -1;
|
||||
|
||||
unsigned int Feb_Control_trimbit_size;
|
||||
unsigned int* Feb_Control_last_downloaded_trimbits;
|
||||
|
||||
@ -1382,7 +1386,7 @@ int Feb_Control_SetSubFrameExposureTime(int the_subframe_exposure_time_in_10nsec
|
||||
printf("Sub Frame Exposure time set to: %d\n",Feb_Control_subframe_exposure_time_in_10nsec);
|
||||
return 1;
|
||||
}
|
||||
int Feb_Control_GetSubFrameExposureTime(){return Feb_Control_subframe_exposure_time_in_10nsec;}
|
||||
int Feb_Control_GetSubFrameExposureTime(){return Feb_Control_subframe_exposure_time_in_10nsec*10;}
|
||||
|
||||
int Feb_Control_SetExposurePeriod(double the_exposure_period_in_sec){
|
||||
Feb_Control_exposure_period_in_sec = the_exposure_period_in_sec;
|
||||
@ -1792,35 +1796,110 @@ int Feb_Control_PulseChip(int npulses){
|
||||
}
|
||||
|
||||
|
||||
int Feb_Control_PrintCorrectedValues(){
|
||||
int i;
|
||||
int delta, slope, base, lsb, corr;
|
||||
for (i=0; i < 4096; i++)
|
||||
{
|
||||
lsb = i&3;
|
||||
base = Feb_Control_rate_correction_table[i>>2] & 0x3fff;
|
||||
slope = ((Feb_Control_rate_correction_table[i>>2] & 0x3c000) >> 14);
|
||||
delta = slope*lsb;
|
||||
corr = delta+base;
|
||||
printf("Readout Input: %d,\tBase:%d,\tSlope:%d,\tLSB:%d,\tDelta:%d\tResult:%d\tReal:%f\n",
|
||||
i, base, slope, lsb, delta, corr, Feb_Control_rate_meas[i]);
|
||||
|
||||
int Feb_Control_Get_RateTable_Tau_in_nsec(){ return Feb_Control_RateTable_Tau_in_nsec;}
|
||||
int Feb_Control_Get_RateTable_Subexptime_in_nsec(){ return Feb_Control_RateTable_Subexptime_in_nsec;}
|
||||
|
||||
int Feb_Control_SetRateCorrectionTau(int tau_in_Nsec){
|
||||
|
||||
double sub_expure_time_in_sec = (double)(Feb_Control_GetSubFrameExposureTime())/(double)1e9;
|
||||
double tau_in_sec = (double)tau_in_Nsec/(double)1e9;
|
||||
unsigned int np = 16384; //max slope 16 * 1024
|
||||
double b0[1024];
|
||||
double m[1024];
|
||||
|
||||
|
||||
if(tau_in_sec<0||sub_expure_time_in_sec<0){
|
||||
printf("Error tau %f and sub_expure_time %f must be greater than 0.\n", tau_in_sec, sub_expure_time_in_sec);
|
||||
return 0;
|
||||
}
|
||||
return 1;
|
||||
|
||||
printf("\tCalculating table for tau of %f ns.\n", tau_in_Nsec);
|
||||
|
||||
for(int i=0;i<np;i++)
|
||||
Feb_Control_rate_meas[i] = i*exp(-i/sub_expure_time_in_sec*tau_in_sec);
|
||||
|
||||
/*
|
||||
b : index/address of block ram/rate correction table
|
||||
b0 : base in vhdl
|
||||
m : slope in vhdl
|
||||
|
||||
Firmware:
|
||||
data_in(11..2) -> memory address --> memory
|
||||
data_in( 1..0) -> lsb
|
||||
|
||||
mem_data_out(13.. 0) -> base
|
||||
mem_data_out(17..14) -> slope
|
||||
|
||||
delta = slope*lsb
|
||||
corr = base+delta
|
||||
*/
|
||||
|
||||
int next_i=0;
|
||||
|
||||
b0[0] = 0;
|
||||
m[0] = 1;
|
||||
|
||||
for(int b=1;b<1024;b++){
|
||||
if(m[b-1]<14.5){
|
||||
double s=0,sx=0,sy=0,sxx=0,sxy=0;
|
||||
for(;;next_i++){
|
||||
if(next_i>=np){
|
||||
cprintf(BG_RED,"Error bin problem ???\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
double x = Feb_Control_rate_meas[next_i] - b*4;
|
||||
double y = next_i;
|
||||
printf("Start Loop x: %f,\t y: %f,\t s: %f,\t sx: %f,\t sy: %f,\t sxx: %f,\t sxy: %f,\t "
|
||||
"next_i: %d,\t b: %d,\t Feb_Control_rate_meas[next_i]: %f\n",
|
||||
x, y, s, sx, sy, sxx, sxy, next_i, b, Feb_Control_rate_meas[next_i]);
|
||||
|
||||
if(x < -0.5) continue;
|
||||
if(x > 3.5) break;
|
||||
s += 1;
|
||||
sx += x;
|
||||
sy += y;
|
||||
sxx += x*x;
|
||||
sxy += x*y;
|
||||
printf("End Loop x: %f,\t y: %f,\t s: %f,\t sx: %f,\t sy: %f,\t sxx: %f,\t sxy: %f,\t "
|
||||
"next_i: %d,\t b: %d,\t Feb_Control_rate_meas[next_i]: %f\n",
|
||||
x, y, s, sx, sy, sxx, sxy, next_i, b, Feb_Control_rate_meas[next_i]);
|
||||
}
|
||||
double delta = s*sxx - sx*sx;
|
||||
b0[b] = (sxx*sy - sx*sxy)/delta;
|
||||
m[b] = (s*sxy - sx*sy) /delta;
|
||||
|
||||
if(m[b]<0||m[b]>15)
|
||||
m[b]=15;
|
||||
printf("After Loop s: %f,\t sx: %f,\t sy: %f,\t sxx: %f,\t sxy: %f,\t "
|
||||
"next_i: %d,\t b: %d,\t Feb_Control_rate_meas[next_i]: %f\n",
|
||||
s, sx, sy, sxx, sxy, next_i, b, Feb_Control_rate_meas[next_i]);
|
||||
// cout<<s<<" "<<sx<<" "<<sy<<" "<<sxx<<" "<<" "<<sxy<<" "<<delta<<" "<<m[b]<<" "<<b0[b]<<endl;
|
||||
}else{
|
||||
b0[b] = b0[b-1] + 4*m[b-1];
|
||||
m[b] = m[b-1];
|
||||
printf("else\n");
|
||||
}
|
||||
Feb_Control_rate_correction_table[b] = (((int)(m[b]+0.5)&0xf)<<14) | ((int)(b0[b]+0.5)&0x3fff);
|
||||
printf("After Loop 4*b: %d\tbase:%d\tslope:%d\n",4*b, (int)(b0[b]+0.5), (int)(m[b]+0.5) );
|
||||
}
|
||||
|
||||
if(SetRateCorrectionTable(Feb_Control_rate_correction_table)){
|
||||
Feb_Control_RateTable_Tau_in_nsec = tau_in_Nsec;
|
||||
Feb_Control_RateTable_Subexptime_in_nsec = Feb_Control_GetSubFrameExposureTime();
|
||||
return 1;
|
||||
}else{
|
||||
Feb_Control_RateTable_Tau_in_nsec = -1;
|
||||
Feb_Control_RateTable_Subexptime_in_nsec = -1;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
void Feb_Control_SetRateCorrectionVariable(int activate_rate_correction){
|
||||
if(activate_rate_correction){
|
||||
Feb_Control_subFrameMode |= DAQ_NEXPOSURERS_ACTIVATE_RATE_CORRECTION;
|
||||
printf("Rate correction activated.\n");
|
||||
printf("Note, the rate correction will only be applied when the detector is run in auto summing 12 bit mode.\n");
|
||||
}else{
|
||||
Feb_Control_subFrameMode &= ~DAQ_NEXPOSURERS_ACTIVATE_RATE_CORRECTION;
|
||||
printf("Rate correction deactivated.\n");
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
int Feb_Control_SetRateCorrectionTable(unsigned int *table){
|
||||
if(!table){
|
||||
@ -1836,110 +1915,47 @@ int Feb_Control_SetRateCorrectionTable(unsigned int *table){
|
||||
if(!Feb_Interface_WriteMemoryInLoops(Module_GetTopLeftAddress(&modules[Feb_Control_current_index]),1,0,1024,Feb_Control_rate_correction_table)||
|
||||
!Feb_Interface_WriteMemoryInLoops(Module_GetTopRightAddress(&modules[Feb_Control_current_index]),1,0,1024,Feb_Control_rate_correction_table)||
|
||||
!Feb_Control_StartDAQOnlyNWaitForFinish(5000)){
|
||||
printf(" some errror!\n");
|
||||
cprintf(BG_RED,"Error in Top Writing to Memory ::Feb_Control_SetRateCorrectionTable\n");
|
||||
return 0;
|
||||
}
|
||||
}else{
|
||||
if(!Feb_Interface_WriteMemoryInLoops(Module_GetBottomLeftAddress(&modules[Feb_Control_current_index]),1,0,1024,Feb_Control_rate_correction_table)||
|
||||
!Feb_Interface_WriteMemoryInLoops(Module_GetBottomRightAddress(&modules[Feb_Control_current_index]),1,0,1024,Feb_Control_rate_correction_table)||
|
||||
!Feb_Control_StartDAQOnlyNWaitForFinish(5000)){
|
||||
printf(" some errror!\n");
|
||||
cprintf(BG_RED,"Error in Bottom Writing to Memory ::Feb_Control_SetRateCorrectionTable\n");
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
SetRateCorrectionVariable(1,print_info);
|
||||
return 1;
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
int Feb_Control_SetRateCorrectionTau(double tau){
|
||||
//sub_expure_time should be known
|
||||
|
||||
unsigned int np = 16384; //max slope 16 * 1024
|
||||
double b0[1024];
|
||||
double m[1024];
|
||||
void Feb_Control_SetRateCorrectionVariable(int activate_rate_correction){
|
||||
if(activate_rate_correction){
|
||||
Feb_Control_subFrameMode |= DAQ_NEXPOSURERS_ACTIVATE_RATE_CORRECTION;
|
||||
printf("Rate correction activated.\n");
|
||||
printf("Note, the rate correction will only be applied when the detector is run in auto summing 12 bit mode.\n");
|
||||
}else{
|
||||
Feb_Control_subFrameMode &= ~DAQ_NEXPOSURERS_ACTIVATE_RATE_CORRECTION;
|
||||
printf("Rate correction deactivated.\n");
|
||||
}
|
||||
}
|
||||
|
||||
if(tau<0||sub_expure_time<0)
|
||||
{
|
||||
printf("Error tau %f and sub_expure_time %f must be greater than 0.\n", tau, sub_expure_time);
|
||||
return 0;
|
||||
|
||||
int Feb_Control_PrintCorrectedValues(){
|
||||
int i;
|
||||
int delta, slope, base, lsb, corr;
|
||||
for (i=0; i < 4096; i++){
|
||||
lsb = i&3;
|
||||
base = Feb_Control_rate_correction_table[i>>2] & 0x3fff;
|
||||
slope = ((Feb_Control_rate_correction_table[i>>2] & 0x3c000) >> 14);
|
||||
delta = slope*lsb;
|
||||
corr = delta+base;
|
||||
printf("Readout Input: %d,\tBase:%d,\tSlope:%d,\tLSB:%d,\tDelta:%d\tResult:%d\tReal:%f\n",
|
||||
i, base, slope, lsb, delta, corr, Feb_Control_rate_meas[i]);
|
||||
}
|
||||
|
||||
printf("\tCalculating table for tau of %f ns.\n", tau*1e9);
|
||||
|
||||
// Basic rate correction table
|
||||
for(int i=0;i<np;i++)
|
||||
meas[i] = i*exp(-i/sub_expure_time*tau);
|
||||
|
||||
|
||||
// b : index/address of block ram/rate correction table
|
||||
// b0 : base in vhdl
|
||||
// m : slope in vhdl
|
||||
//
|
||||
// Firmware:
|
||||
// data_in(11..2) -> memory address --> memory
|
||||
// data_in( 1..0) -> lsb
|
||||
//
|
||||
// mem_data_out(13.. 0) -> base
|
||||
// mem_data_out(17..14) -> slope
|
||||
//
|
||||
// delta = slope*lsb
|
||||
// corr = base+delta
|
||||
|
||||
int next_i=0;
|
||||
|
||||
b0[0] = 0;
|
||||
m[0] = 1;
|
||||
|
||||
for(int b=1;b<1024;b++)
|
||||
{
|
||||
if(m[b-1]<14.5)
|
||||
{
|
||||
double s=0,sx=0,sy=0,sxx=0,sxy=0;
|
||||
for(;;next_i++)
|
||||
{
|
||||
if(next_i>=np)
|
||||
{
|
||||
printf("Error bin problem ???????\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
double x = meas[next_i] - b*4;
|
||||
double y = next_i;
|
||||
printf("Start Loop x: %f,\t y: %f,\t s: %f,\t sx: %f,\t sy: %f,\t sxx: %f,\t sxy: %f,\t next_i: %d,\t b: %d,\t meas[next_i]: %f\n", x, y, s, sx, sy, sxx, sxy, next_i, b, meas[next_i]);
|
||||
|
||||
if(x < -0.5) continue;
|
||||
if(x > 3.5) break;
|
||||
s += 1;
|
||||
sx += x;
|
||||
sy += y;
|
||||
sxx += x*x;
|
||||
sxy += x*y;
|
||||
printf("End Loop x: %f,\t y: %f,\t s: %f,\t sx: %f,\t sy: %f,\t sxx: %f,\t sxy: %f,\t next_i: %d,\t b: %d,\t meas[next_i]: %f\n", x, y, s, sx, sy, sxx, sxy, next_i, b, meas[next_i]);
|
||||
}
|
||||
double delta = s*sxx - sx*sx;
|
||||
b0[b] = (sxx*sy - sx*sxy)/delta;
|
||||
m[b] = (s*sxy - sx*sy) /delta;
|
||||
|
||||
if(m[b]<0||m[b]>15)
|
||||
m[b]=15;
|
||||
printf("After Loop s: %f,\t sx: %f,\t sy: %f,\t sxx: %f,\t sxy: %f,\t next_i: %d,\t b: %d,\t meas[next_i]: %f\n", s, sx, sy, sxx, sxy, next_i, b, meas[next_i]);
|
||||
// cout<<s<<" "<<sx<<" "<<sy<<" "<<sxx<<" "<<" "<<sxy<<" "<<delta<<" "<<m[b]<<" "<<b0[b]<<endl;
|
||||
}else
|
||||
{
|
||||
b0[b] = b0[b-1] + 4*m[b-1];
|
||||
m[b] = m[b-1];
|
||||
printf("else\n");
|
||||
}
|
||||
rate_correction_table[b] = (((int)(m[b]+0.5)&0xf)<<14) | ((int)(b0[b]+0.5)&0x3fff);
|
||||
printf("After Loop 4*b: %d\tbase:%d\tslope:%d\n",4*b, (int)(b0[b]+0.5), (int)(m[b]+0.5) );
|
||||
}
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
Reference in New Issue
Block a user