void test_sequence_n(Sequence & seq, mpl::int_<1>)
{
fobj f;
COMPARE_EFFECT(f(element1), fusion::invoke_procedure(f , seq ));
COMPARE_EFFECT(f(element1), fusion::invoke_procedure(f , const_(seq)));
COMPARE_EFFECT(const_(f)(element1), fusion::invoke_procedure<fobj const >(const_(f), seq ));
COMPARE_EFFECT(const_(f)(element1), fusion::invoke_procedure<fobj const &>(const_(f), const_(seq)));
fobj_nc nc_f;
COMPARE_EFFECT(nc_f(element1), fusion::invoke_procedure<fobj_nc &>(nc_f, seq ));
COMPARE_EFFECT(nc_f(element1), fusion::invoke_procedure<fobj_nc &>(nc_f, const_(seq)));
COMPARE_EFFECT(const_(nc_f)(element1), fusion::invoke_procedure<fobj_nc const &>(const_(nc_f), seq ));
COMPARE_EFFECT(const_(nc_f)(element1), fusion::invoke_procedure<fobj_nc const &>(const_(nc_f), const_(seq)));
COMPARE_EFFECT(unary(element1), fusion::invoke_procedure<int (&)(int &)>(unary, seq));
COMPARE_EFFECT(func_ptr1(element1), fusion::invoke_procedure(func_ptr1, seq));
COMPARE_EFFECT(func_ptr2(element1), fusion::invoke_procedure(func_ptr2, seq));
COMPARE_EFFECT(func_ptr3(element1), fusion::invoke_procedure(func_ptr3, seq));
COMPARE_EFFECT(func_ptr4(element1), fusion::invoke_procedure(func_ptr4, seq));
COMPARE_EFFECT(that.unary(element1), fusion::invoke_procedure(& members::unary, fusion::join(sv_ref_ctx,seq)));
COMPARE_EFFECT(that.unary(element1), fusion::invoke_procedure(& members::unary, fusion::join(sv_ptr_ctx,seq)));
COMPARE_EFFECT(that.unary(element1), fusion::invoke_procedure(& members::unary, fusion::join(sv_spt_ctx,seq)));
COMPARE_EFFECT(that.unary_c(element1), fusion::invoke_procedure(& members::unary_c, fusion::join(sv_obj_ctx,seq)));
COMPARE_EFFECT(that.unary_c(element1), fusion::invoke_procedure(& members::unary_c, fusion::join(sv_ref_ctx,seq)));
COMPARE_EFFECT(that.unary_c(element1), fusion::invoke_procedure(& members::unary_c, fusion::join(sv_ptr_ctx,seq)));
COMPARE_EFFECT(that.unary_c(element1), fusion::invoke_procedure(& members::unary_c, fusion::join(sv_spt_ctx,seq)));
COMPARE_EFFECT(that.unary_c(element1), fusion::invoke_procedure(& members::unary_c, fusion::join(sv_obj_c_ctx,seq)));
COMPARE_EFFECT(that.unary_c(element1), fusion::invoke_procedure(& members::unary_c, fusion::join(sv_ref_c_ctx,seq)));
COMPARE_EFFECT(that.unary_c(element1), fusion::invoke_procedure(& members::unary_c, fusion::join(sv_ptr_c_ctx,seq)));
COMPARE_EFFECT(that.unary_c(element1), fusion::invoke_procedure(& members::unary_c, fusion::join(sv_spt_c_ctx,seq)));
}
void stamp_time(timestamp_seconds_buffer& out, const TimeT *t)
{
struct tm when = t ? *t : TimeT::now();
char buf[20];
strftime(buf, 20, "%Y-%m-%d %H:%M:%S", &when);
out = stringish<timestamp_seconds_buffer>(const_(buf));
}
void test_sequence_n(Sequence & seq, mpl::int_<3>)
{
fobj f;
COMPARE_EFFECT(f(element1, element2, element3), fusion::invoke_procedure(f, seq));
COMPARE_EFFECT(const_(f)(element1, element2, element3), fusion::invoke_procedure<fobj const>(const_(f), seq));
}
void stamp_time(timestamp_milliseconds_buffer& out)
{
struct timeval tv;
gettimeofday(&tv, NULL);
struct tm when = TimeT(tv.tv_sec);
char buf[24];
strftime(buf, 20, "%Y-%m-%d %H:%M:%S", &when);
sprintf(buf + 19, ".%03d", static_cast<int>(tv.tv_usec / 1000));
out = stringish<timestamp_milliseconds_buffer>(const_(buf));
}
bool PreClassEmitter::addAbstractConstant(const StringData* n,
const StringData* typeConstraint,
const bool typeconst) {
auto it = m_constMap.find(n);
if (it != m_constMap.end()) {
return false;
}
PreClassEmitter::Const const_(n, typeConstraint, nullptr, nullptr, typeconst);
m_constMap.add(const_.name(), const_);
return true;
}
bool PreClassEmitter::addConstant(const StringData* n,
const StringData* typeConstraint,
const TypedValue* val,
const StringData* phpCode) {
ConstMap::Builder::const_iterator it = m_constMap.find(n);
if (it != m_constMap.end()) {
return false;
}
PreClassEmitter::Const const_(n, typeConstraint, val, phpCode);
m_constMap.add(const_.name(), const_);
return true;
}
void test_sequence_n(Sequence & seq, mpl::int_<2>)
{
fobj f;
COMPARE_EFFECT(f (element1, element2), fusion::invoke_procedure(f , seq));
COMPARE_EFFECT(f (element1, const_(element2)), fusion::invoke_procedure(f , const_(seq)));
COMPARE_EFFECT(const_(f)(element1, element2), fusion::invoke_procedure<fobj const>(const_(f), seq));
COMPARE_EFFECT(const_(f)(element1, const_(element2)), fusion::invoke_procedure<fobj const>(const_(f), const_(seq)));
COMPARE_EFFECT(binary1(element1, element2), fusion::invoke_procedure(binary1, seq));
COMPARE_EFFECT(binary2(element1, element2), fusion::invoke_procedure(binary2, seq));
COMPARE_EFFECT(that.binary(element1,element2), fusion::invoke_procedure(& members::binary, fusion::join(sv_ref_ctx,seq)));
COMPARE_EFFECT(that.binary(element1,element2), fusion::invoke_procedure(& members::binary, fusion::join(sv_ptr_ctx,seq)));
COMPARE_EFFECT(that.binary(element1,element2), fusion::invoke_procedure(& members::binary, fusion::join(sv_spt_ctx,seq)));
COMPARE_EFFECT(that.binary_c(element1,element2), fusion::invoke_procedure(& members::binary_c, fusion::join(sv_obj_ctx,seq)));
COMPARE_EFFECT(that.binary_c(element1,element2), fusion::invoke_procedure(& members::binary_c, fusion::join(sv_ref_ctx,seq)));
COMPARE_EFFECT(that.binary_c(element1,element2), fusion::invoke_procedure(& members::binary_c, fusion::join(sv_ptr_ctx,seq)));
COMPARE_EFFECT(that.binary_c(element1,element2), fusion::invoke_procedure(& members::binary_c, fusion::join(sv_spt_ctx,seq)));
COMPARE_EFFECT(that.binary_c(element1,element2), fusion::invoke_procedure(& members::binary_c, fusion::join(sv_obj_c_ctx,seq)));
COMPARE_EFFECT(that.binary_c(element1,element2), fusion::invoke_procedure(& members::binary_c, fusion::join(sv_ref_c_ctx,seq)));
COMPARE_EFFECT(that.binary_c(element1,element2), fusion::invoke_procedure(& members::binary_c, fusion::join(sv_ptr_c_ctx,seq)));
COMPARE_EFFECT(that.binary_c(element1,element2), fusion::invoke_procedure(& members::binary_c, fusion::join(sv_spt_c_ctx,seq)));
}
signal_ & find_segment::comp3_class::operator()
(
signal_& a__io,
signal_& b__io,
signal_& c__io
)
{
if (!built)
{
build();
}
a.attach(a__io);
b.attach(b__io);
c.attach(c__io);
{
r[2] = a <= b;
r[1] = b <= c;
r[0] = c <= a;
if (( (r) == 0)) { comp3_retval = const_(2, 0x3UL); } else
if (( (r) == // invalid
1)) { comp3_retval = const_(2, 0x2UL); } else
if (( (r) == // c
2)) { comp3_retval = const_(2, 0x1UL); } else
if (( (r) == // b
3)) { comp3_retval = const_(2, 0x1UL); } else
if (( (r) == // b
4)) { comp3_retval = const_(2, 0x0UL); } else
if (( (r) == // a
5)) { comp3_retval = const_(2, 0x2UL); } else
if (( (r) == // c
6)) { comp3_retval = const_(2, 0x0UL); } else
if (( (r) == // a
7)) { comp3_retval = const_(2, 0x0UL); }
}
return comp3_retval;
}
void best_tracks::operator()
(
signal_& phi__io,
signal_& theta__io,
signal_& cpattern__io,
signal_& delta_ph__io,
signal_& delta_th__io,
signal_& sign_ph__io,
signal_& sign_th__io,
signal_& rank__io,
signal_& vi__io,
signal_& hi__io,
signal_& ci__io,
signal_& si__io,
signal_& bt_phi__io,
signal_& bt_theta__io,
signal_& bt_cpattern__io,
signal_& bt_delta_ph__io,
signal_& bt_delta_th__io,
signal_& bt_sign_ph__io,
signal_& bt_sign_th__io,
signal_& bt_rank__io,
signal_& bt_vi__io,
signal_& bt_hi__io,
signal_& bt_ci__io,
signal_& bt_si__io,
signal_& clk__io
)
{
if (!built)
{
seg_ch = 2;
bw_ph = 8;
bw_th = 7;
bw_fph = 12;
bw_fth = 8;
bw_wg = 7;
bw_ds = 7;
bw_hs = 8;
pat_w_st3 = 3;
pat_w_st1 = pat_w_st3 + 1;
full_pat_w_st3 = (1 << (pat_w_st3+1)) - 1;
full_pat_w_st1 = (1 << (pat_w_st1+1)) - 1;
padding_w_st1 = full_pat_w_st1 / 2;
padding_w_st3 = full_pat_w_st3 / 2;
red_pat_w_st3 = pat_w_st3 * 2 + 1;
red_pat_w_st1 = pat_w_st1 * 2 + 1;
fold = 4;
th_ch11 = seg_ch*seg_ch;
bw_q = 4;
bw_addr = 7;
ph_raw_w = (1 << pat_w_st3) * 15 + 2;
th_raw_w = (1 << bw_th);
max_drift = 3;
bw_phi = 12;
bw_eta = 7;
ph_hit_w = 40+4;
ph_hit_w20 = ph_hit_w;
ph_hit_w10 = 20+4;
th_hit_w = 56 + 8;
endcap = 1;
n_strips = (station <= 1 && cscid <= 2) ? 64 :
(station <= 1 && cscid >= 6) ? 64 : 80;
n_wg = (station <= 1 && cscid <= 3) ? 48 :
(station <= 1 && cscid >= 6) ? 32 :
(station == 2 && cscid <= 3) ? 112 :
(station >= 3 && cscid <= 3) ? 96 : 64;
th_coverage = (station <= 1 && cscid <= 2) ? 45 :
(station <= 1 && cscid >= 6) ? 27 :
(station <= 1 && cscid >= 3) ? 39 :
(station == 2 && cscid <= 2) ? 43 :
(station == 2 && cscid >= 3) ? 56 :
(station == 3 && cscid <= 2) ? 34 :
(station == 3 && cscid >= 3) ? 52 :
(station == 4 && cscid <= 2) ? 28 :
(station == 4 && cscid >= 3) ? 50 : 0;
ph_coverage = (station <= 1 && cscid >= 6) ? 15 : //30 :
(station >= 2 && cscid <= 2) ? 40 : 20;
th_ch = (station <= 1 && cscid <= 2) ? (seg_ch*seg_ch) : seg_ch;
ph_reverse = (endcap == 1 && station >= 3) ? 1 :
(endcap == 2 && station < 3) ? 1 : 0;
th_mem_sz = (1 << bw_addr);
th_corr_mem_sz = (1 << bw_addr);
mult_bw = bw_fph + 11;
ph_zone_bnd1 = (station <= 1 && cscid <= 2) ? 41 :
(station == 2 && cscid <= 2) ? 41 :
(station == 2 && cscid > 2) ? 87 :
(station == 3 && cscid > 2) ? 49 :
(station == 4 && cscid > 2) ? 49 : 127;
ph_zone_bnd2 = (station == 3 && cscid > 2) ? 87 : 127;
zone_overlap = 2;
bwr = 6;
bpow = 6;
cnr = (1 << bpow);
cnrex = ph_raw_w;
build();
// precise phi and theta of candidates
// [zone][pattern_num]
phi.attach(phi__io);
theta.attach(theta__io);
cpattern.attach(cpattern__io);
// ph and th deltas from best stations
// [zone][pattern_num], last index: [0] - best pair of stations, [1] - second best pair
delta_ph.attach(delta_ph__io);
delta_th.attach(delta_th__io);
sign_ph.attach(sign_ph__io);
sign_th.attach(sign_th__io);
// updated ranks [zone][pattern_num]
rank.attach(rank__io);
//[zone][pattern_num][station 0-3]
vi.attach(vi__io);
hi.attach(hi__io);
ci.attach(ci__io);
si.attach(si__io);
clk.attach(clk__io);
// precise phi and theta of best tracks
// [best_track_num]
bt_phi.attach(bt_phi__io);
bt_theta.attach(bt_theta__io);
bt_cpattern.attach(bt_cpattern__io);
// ph and th deltas from best stations
// [best_track_num], last index: [0] - best pair of stations, [1] - second best pair
bt_delta_ph.attach(bt_delta_ph__io);
bt_delta_th.attach(bt_delta_th__io);
bt_sign_ph.attach(bt_sign_ph__io);
bt_sign_th.attach(bt_sign_th__io);
// ranks [best_track_num]
bt_rank.attach(bt_rank__io);
//[best_track_num][station 0-3]
bt_vi.attach(bt_vi__io);
bt_hi.attach(bt_hi__io);
bt_ci.attach(bt_ci__io);
bt_si.attach(bt_si__io);
}
beginalways();
if (posedge (clk))
{
// zero segment numbers
for (z = 0; z < 4; z = z+1) // zone loop
{
for (n = 0; n < 3; n = n+1) // pattern number
{
for (s = 0; s < 5; s = s+1) // station
{
cn_vi[z][n][s] = 0;
cn_hi[z][n][s] = 0;
cn_si[z][n][s] = 0;
cn_ci[z][n][s] = 0;
}
}
}
// input segment numbers are in terms of chambers in zone
// convert them back into chamber ids in sector
for (z = 0; z < 4; z = z+1) // zone loop
{
for (n = 0; n < 3; n = n+1) // pattern number
{
for (s = 0; s < 4; s = s+1) // station
{
// calculate real station and chamber numbers
cham = ci[z][n][s];
if (s == 0)
{
real_st = (cham < 3) ? 0 : 1;
real_ch = cham % 3; // will this synthesize OK?
if (z == 2) real_ch = real_ch + const_(3, 3UL);
if (z == 3) real_ch = real_ch + const_(3, 6UL);
}
else
if (s == 1)
{
real_st = s + 1;
real_ch = cham;
if (z > 1) real_ch = real_ch + const_(3, 3UL);
}
else
{
real_st = s + 1;
real_ch = cham;
if (z > 0) real_ch = real_ch + const_(3, 3UL);
}
cn_vi[z][n][real_st] = vi[z][n][s];
cn_hi[z][n][real_st] = hi[z][n][s];
cn_si[z][n][real_st] = si[z][n][s];
cn_ci[z][n][real_st] = real_ch;
}
}
}
// zero outputs initially
for (n = 0; n < 3; n = n+1)
{
winner[n] = 0;
bt_rank [n] = 0;
bt_phi[n] = 0;
bt_theta[n] = 0;
bt_cpattern[n] = 0;
for (s = 0; s < 2; s = s+1) // delta loop
{
bt_delta_ph [n][s] = 0;
bt_sign_ph [n][s] = 0;
bt_delta_th [n][s] = 0;
bt_sign_th [n][s] = 0;
}
for (s = 0; s < 5; s = s+1) // station loop
{
bt_vi[n][s] = 0;
bt_hi[n][s] = 0;
bt_si[n][s] = 0;
bt_ci[n][s] = 0;
}
}
// simultaneously compare each rank with each
for (i = 0; i < 12; i = i+1)
{
larger[i] = 0;
larger[i][i] = 1; // result of comparison with itself
ri = rank[i%4][i/4]; // first index loops zone, second loops candidate. Zone loops faster, so we give equal priority to zones
for (j = 0; j < 12; j = j+1)
{
// ilgj bits show which rank is larger
// the comparison scheme below avoids problems
// when there are two | more tracks with the same rank
rj = rank[j%4][j/4];
gt = ri > rj;
eq = ri == rj;
if ((i < j && (gt || eq)) || (i > j && gt)) larger[i][j] = 1;
}
// "larger" array shows the result of comparison for each rank
// track exists if quality != 0
exists[i] = (ri != 0);
}
// ghost cancellation, only in the current BX so far
kill1 = 0;
for (i = 0; i < 12; i = i+1) // candidate loop
{
for (j = i+1; j < 12; j = j+1) // comparison candidate loop
{
sh_segs = 0;
// count shared segments
for (s = 0; s < 5; s = s+1) // station loop
{
if (cn_vi[i%4][i/4][s] && cn_vi[j%4][j/4][s] && // both segments valid
cn_ci[i%4][i/4][s] == cn_ci[j%4][j/4][s] && // from same chamber
cn_si[i%4][i/4][s] == cn_si[j%4][j/4][s]) // same segment
sh_segs = sh_segs + const_(3, 0x1UL); // increment shared segment counter
}
if (sh_segs > 0) // a single shared segment means const_s(it, ) ghost
{
// kill candidate that has lower rank
if (larger[i][j]) kill1[j] = 1;
else kill1[i] = 1;
}
}
}
// remove ghosts according to kill mask
exists = exists & (~kill1);
for (i = 0; i < 12; i = i+1)
{
if (exists[i]) larger[i] = larger[i] | (~exists); // if this track exists make it larger than all non-existing tracks
else larger[i] = 0; // else make it smaller than anything
// count zeros in the comparison results. The best track will have none, the next will have one, the third will have two.
// skip the bits corresponding to the comparison of the track with itself
sum = 0;
for (j = 0; j < 12; j = j+1) if (larger[i][j] == 0) sum = sum + 1;
if (sum < 3) winner[sum][i] = 1; // positional winner codes
}
// multiplex best tracks to outputs according to winner signals
for (n = 0; n < 3; n = n+1) // output loop
{
for (i = 0; i < 12; i = i+1) // winner bit loop
{
if (winner[n][i])
{
bt_rank [n] = bt_rank [n] | rank [i%4][i/4];
bt_phi[n] = bt_phi[n] | phi[i%4][i/4];
bt_theta[n] = bt_theta[n] | theta[i%4][i/4];
bt_cpattern[n] = bt_cpattern[n] | cpattern[i%4][i/4];
for (s = 0; s < 2; s = s+1) // delta loop
{
bt_delta_ph [n][s] = bt_delta_ph [n][s] | delta_ph [i%4][i/4][s];
bt_sign_ph [n][s] = bt_sign_ph [n][s] | sign_ph [i%4][i/4][s];
bt_delta_th [n][s] = bt_delta_th [n][s] | delta_th [i%4][i/4][s];
bt_sign_th [n][s] = bt_sign_th [n][s] | sign_th [i%4][i/4][s];
}
for (s = 0; s < 5; s = s+1) // station loop
{
bt_vi[n][s] = bt_vi[n][s] | cn_vi[i%4][i/4][s];
bt_hi[n][s] = bt_hi[n][s] | cn_hi[i%4][i/4][s];
bt_ci[n][s] = bt_ci[n][s] | cn_ci[i%4][i/4][s];
bt_si[n][s] = bt_si[n][s] | cn_si[i%4][i/4][s];
}
}
}
}
}
endalways();
}
void deltas::operator()
(
signal_& vi__io,
signal_& hi__io,
signal_& ci__io,
signal_& si__io,
signal_& ph_match__io,
signal_& th_match__io,
signal_& th_match11__io,
signal_& cpat_match__io,
signal_& ph_q__io,
signal_& th_window__io,
signal_& phi__io,
signal_& theta__io,
signal_& cpattern__io,
signal_& delta_ph__io,
signal_& delta_th__io,
signal_& sign_ph__io,
signal_& sign_th__io,
signal_& rank__io,
signal_& vir__io,
signal_& hir__io,
signal_& cir__io,
signal_& sir__io,
signal_& clk__io
)
{
if (!built)
{
seg_ch = 2;
bw_ph = 8;
bw_th = 7;
bw_fph = 12;
bw_fth = 8;
bw_wg = 7;
bw_ds = 7;
bw_hs = 8;
pat_w_st3 = 3;
pat_w_st1 = pat_w_st3 + 1;
full_pat_w_st3 = (1 << (pat_w_st3+1)) - 1;
full_pat_w_st1 = (1 << (pat_w_st1+1)) - 1;
padding_w_st1 = full_pat_w_st1 / 2;
padding_w_st3 = full_pat_w_st3 / 2;
red_pat_w_st3 = pat_w_st3 * 2 + 1;
red_pat_w_st1 = pat_w_st1 * 2 + 1;
fold = 4;
th_ch11 = seg_ch*seg_ch;
bw_q = 4;
bw_addr = 7;
ph_raw_w = (1 << pat_w_st3) * 15;
th_raw_w = (1 << bw_th);
max_drift = 3;
bw_phi = 12;
bw_eta = 7;
ph_hit_w = 40+4;
ph_hit_w20 = ph_hit_w;
ph_hit_w10 = 20+4;
th_hit_w = 56 + 8;
endcap = 1;
n_strips = (station <= 1 && cscid <= 2) ? 64 :
(station <= 1 && cscid >= 6) ? 64 : 80;
n_wg = (station <= 1 && cscid <= 3) ? 48 :
(station <= 1 && cscid >= 6) ? 32 :
(station == 2 && cscid <= 3) ? 112 :
(station >= 3 && cscid <= 3) ? 96 : 64;
th_coverage = (station <= 1 && cscid <= 2) ? 45 :
(station <= 1 && cscid >= 6) ? 27 :
(station <= 1 && cscid >= 3) ? 39 :
(station == 2 && cscid <= 2) ? 43 :
(station == 2 && cscid >= 3) ? 56 :
(station == 3 && cscid <= 2) ? 34 :
(station == 3 && cscid >= 3) ? 52 :
(station == 4 && cscid <= 2) ? 28 :
(station == 4 && cscid >= 3) ? 50 : 0;
ph_coverage = (station <= 1 && cscid >= 6) ? 15 : //30 :
(station >= 2 && cscid <= 2) ? 40 : 20;
th_ch = (station <= 1 && cscid <= 2) ? (seg_ch*seg_ch) : seg_ch;
ph_reverse = (endcap == 1 && station >= 3) ? 1 :
(endcap == 2 && station < 3) ? 1 : 0;
th_mem_sz = (1 << bw_addr);
th_corr_mem_sz = (1 << bw_addr);
mult_bw = bw_fph + 11;
ph_zone_bnd1 = (station <= 1 && cscid <= 2) ? 41 :
(station == 2 && cscid <= 2) ? 41 :
(station == 2 && cscid > 2) ? 87 :
(station == 3 && cscid > 2) ? 49 :
(station == 4 && cscid > 2) ? 49 : 127;
ph_zone_bnd2 = (station == 3 && cscid > 2) ? 87 : 127;
zone_overlap = 2;
bwr = 6;
bpow = 6;
cnr = (1 << bpow);
cnrex = ph_raw_w;
seg1 = me11 ? th_ch11 : seg_ch;
bw_nm1 = me11 ? 3 : 2;
bw_nm2 = 2;
build();
// input parameters [station]
vi.attach(vi__io);
hi.attach(hi__io);
ci.attach(ci__io);
si.attach(si__io);
ph_match.attach(ph_match__io);
// theta coordinates [station][segment]
th_match.attach(th_match__io);
// ME11 duplicated thetas [segment]
th_match11.attach(th_match11__io);
cpat_match.attach(cpat_match__io);
ph_q.attach(ph_q__io);
th_window.attach(th_window__io);
clk.attach(clk__io);
// precise phi and theta
phi.attach(phi__io);
theta.attach(theta__io);
cpattern.attach(cpattern__io);
// ph and th deltas from best stations [0] - best pair of stations, [1] - second best pair
delta_ph.attach(delta_ph__io);
delta_th.attach(delta_th__io);
sign_ph.attach(sign_ph__io);
sign_th.attach(sign_th__io);
rank.attach(rank__io);
vir.attach(vir__io);
hir.attach(hir__io);
cir.attach(cir__io);
sir.attach(sir__io);
}
dvalid = dvl12 != 0 || dvl13 != 0 || dvl14 != 0 || dvl23 != 0 || dvl24 != 0 || dvl34 != 0;
// difference sorters
bd12.nseg = seg1*seg_ch;
bd13.nseg = seg1*seg_ch;
bd14.nseg = seg1*seg_ch;
bd23.nseg = seg_ch*seg_ch;
bd24.nseg = seg_ch*seg_ch;
bd34.nseg = seg_ch*seg_ch;
if (true)
{
for (i1 = 0; i1 < 3; i1 = i1+1) // station 1 loop
{
for (i2 = i1+1; i2 < 4; i2 = i2+1) // station 2 loop
{
// calculate theta deltas
for (j = 0; j < ((i1==0) ? seg1 : seg_ch); j = j+1) // segment st A loop
{
for (k = 0; k < seg_ch; k = k+1) // segment st B loop
{
if (me11)
thA = (i1 == 0) ? th_match11[j] : th_match[i1][j];
else
thA = th_match[i1][j];
thB = th_match[i2][k];
dth = (thA > thB) ? thA - thB : thB - thA;
sth = (thA > thB); // sign
// if one of the segments not valid, delta not valid
dvl = vi[i1][j%seg_ch] & vi[i2][k];
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x1UL))) { { dth12[j*seg_ch + k] = dth; dvl12[j*seg_ch + k] = dvl; sth12[j*seg_ch + k] = sth; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x2UL))) { { dth13[j*seg_ch + k] = dth; dvl13[j*seg_ch + k] = dvl; sth13[j*seg_ch + k] = sth; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x3UL))) { { dth14[j*seg_ch + k] = dth; dvl14[j*seg_ch + k] = dvl; sth14[j*seg_ch + k] = sth; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x6UL))) { { dth23[j*seg_ch + k] = dth; dvl23[j*seg_ch + k] = dvl; sth23[j*seg_ch + k] = sth; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x7UL))) { { dth24[j*seg_ch + k] = dth; dvl24[j*seg_ch + k] = dvl; sth24[j*seg_ch + k] = sth; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0xbUL))) { { dth34[j*seg_ch + k] = dth; dvl34[j*seg_ch + k] = dvl; sth34[j*seg_ch + k] = sth; } }
}
} // for (j = 0; j < ((i1==0) ? seg1 : seg_ch); j = j+1)
// calculate phi deltas
phA = ph_match[i1];
phB = ph_match[i2];
dph = (phA > phB) ? phA - phB : phB - phA;
sph = (phA > phB);
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x1UL))) { { dph12 = dph; sph12 = sph; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x2UL))) { { dph13 = dph; sph13 = sph; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x3UL))) { { dph14 = dph; sph14 = sph; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x6UL))) { { dph23 = dph; sph23 = sph; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0x7UL))) { { dph24 = dph; sph24 = sph; } } else
if (( ((i1(1,0), i2(1,0))) == const_(4, 0xbUL))) { { dph34 = dph; sph34 = sph; } }
}
} // for (i = 0; i < 3; i = i+1)
}
beginalways();
if (posedge (clk))
{
// find valid segments
vmask1 = const_(4, 0x0UL);
vmask2 = const_(4, 0x0UL);
vmask3 = const_(4, 0x0UL);
//std::cout<<"\n";
//for(int t=0;t<4;t++){
// std::cout<<"PhiMatch["<<t<<"] = "<<ph_match[t]<<std::endl;
//}
// vmask contains valid station mask = (ME4,ME3,ME2,ME1)
if (bth12 <= th_window && bvl12) vmask1 = vmask1 | const_(4, 0x3UL);
if (bth13 <= th_window && bvl13) vmask1 = vmask1 | const_(4, 0x5UL);
if (bth14 <= th_window && bvl14) vmask1 = vmask1 | const_(4, 0x9UL);
if (bth23 <= th_window && bvl23) vmask2 = vmask2 | const_(4, 0x6UL);
if (bth24 <= th_window && bvl24) vmask2 = vmask2 | const_(4, 0xaUL);
if (bth34 <= th_window && bvl34) vmask3 = vmask3 | const_(4, 0xcUL);
if(vmask1){std::cout<<"vmask1 = "<<vmask1<<std::endl;}
if(vmask2){std::cout<<"vmask2 = "<<vmask2<<std::endl;}
if(vmask3){std::cout<<"vmask3 = "<<vmask3<<std::endl;}
// merge station masks only if they share bits
// could try here to find two tracks with identical ph
// for example vmask1 = 1001 and vmask2 = 0110
// not done so far, just select one with better station combination
vstat = vmask1;
if(vstat){std::cout<<"vstat = "<<vstat<<std::endl;}
if ((vstat & vmask2) != const_(4, 0x0UL) || vstat == const_(4, 0x0UL)) vstat = vstat | vmask2;
if(vstat){std::cout<<"vstat = "<<vstat<<std::endl;}
if ((vstat & vmask3) != const_(4, 0x0UL) || vstat == const_(4, 0x0UL)) vstat = vstat | vmask3;
if(vstat){std::cout<<"vstat = "<<vstat<<std::endl;}
if (( (vstat) == const_(4, 0xcUL))) { { delta_ph[0] = dph34; delta_ph[1] = dph34; delta_th[0] = bth34; delta_th[1] = bth34; } } else
if (( (vstat) == const_(4, 0xaUL))) { { delta_ph[0] = dph24; delta_ph[1] = dph24; delta_th[0] = bth24; delta_th[1] = bth24; } } else
if (( (vstat) == const_(4, 0x6UL))) { { delta_ph[0] = dph23; delta_ph[1] = dph23; delta_th[0] = bth23; delta_th[1] = bth23; } } else
if (( (vstat) == const_(4, 0xeUL))) { { delta_ph[0] = dph23; delta_ph[1] = dph34; delta_th[0] = bth23; delta_th[1] = bth34; } } else
if (( (vstat) == const_(4, 0x9UL))) { { delta_ph[0] = dph14; delta_ph[1] = dph14; delta_th[0] = bth14; delta_th[1] = bth14; } } else
if (( (vstat) == const_(4, 0x5UL))) { { delta_ph[0] = dph13; delta_ph[1] = dph13; delta_th[0] = bth13; delta_th[1] = bth13; } } else
if (( (vstat) == const_(4, 0xdUL))) { { delta_ph[0] = dph13; delta_ph[1] = dph34; delta_th[0] = bth13; delta_th[1] = bth34; } } else
if (( (vstat) == const_(4, 0x3UL))) { { delta_ph[0] = dph12; delta_ph[1] = dph12; delta_th[0] = bth12; delta_th[1] = bth12; } } else
if (( (vstat) == const_(4, 0xbUL))) { { delta_ph[0] = dph12; delta_ph[1] = dph24; delta_th[0] = bth12; delta_th[1] = bth24; } } else
if (( (vstat) == const_(4, 0x7UL))) { { delta_ph[0] = dph12; delta_ph[1] = dph23; delta_th[0] = bth12; delta_th[1] = bth23; } } else
if (( (vstat) == const_(4, 0xfUL))) { { delta_ph[0] = dph12; delta_ph[1] = dph23; delta_th[0] = bth12; delta_th[1] = bth23; } }
if (( (vstat) == const_(4, 0xcUL))) { { sign_ph[0] = sph34; sign_ph[1] = sph34; sign_th[0] = bsg34; sign_th[1] = bsg34; } } else
if (( (vstat) == const_(4, 0xaUL))) { { sign_ph[0] = sph24; sign_ph[1] = sph24; sign_th[0] = bsg24; sign_th[1] = bsg24; } } else
if (( (vstat) == const_(4, 0x6UL))) { { sign_ph[0] = sph23; sign_ph[1] = sph23; sign_th[0] = bsg23; sign_th[1] = bsg23; } } else
if (( (vstat) == const_(4, 0xeUL))) { { sign_ph[0] = sph23; sign_ph[1] = sph34; sign_th[0] = bsg23; sign_th[1] = bsg34; } } else
if (( (vstat) == const_(4, 0x9UL))) { { sign_ph[0] = sph14; sign_ph[1] = sph14; sign_th[0] = bsg14; sign_th[1] = bsg14; } } else
if (( (vstat) == const_(4, 0x5UL))) { { sign_ph[0] = sph13; sign_ph[1] = sph13; sign_th[0] = bsg13; sign_th[1] = bsg13; } } else
if (( (vstat) == const_(4, 0xdUL))) { { sign_ph[0] = sph13; sign_ph[1] = sph34; sign_th[0] = bsg13; sign_th[1] = bsg34; } } else
if (( (vstat) == const_(4, 0x3UL))) { { sign_ph[0] = sph12; sign_ph[1] = sph12; sign_th[0] = bsg12; sign_th[1] = bsg12; } } else
if (( (vstat) == const_(4, 0xbUL))) { { sign_ph[0] = sph12; sign_ph[1] = sph24; sign_th[0] = bsg12; sign_th[1] = bsg24; } } else
if (( (vstat) == const_(4, 0x7UL))) { { sign_ph[0] = sph12; sign_ph[1] = sph23; sign_th[0] = bsg12; sign_th[1] = bsg23; } } else
if (( (vstat) == const_(4, 0xfUL))) { { sign_ph[0] = sph12; sign_ph[1] = sph23; sign_th[0] = bsg12; sign_th[1] = bsg23; } }
// segment ids
vir = vi;
hir = hi;
cir = ci;
sir = si;
// remove some valid flags if th did not line up
for (j = 0; j < 4; j = j+1)
if (vstat[j] == const_(1, 0x0UL)) vir[j] = 0;
// precise phi and theta
phi = 0;
theta = 0;
if (vstat[1] == const_(1, 0x1UL)) // ME2 present
{
// phi is simple, we have it
phi = ph_match[1];
// for theta, select delta to best station, use winner number as index
if (bvl12) theta = th_match[1][bnm12[0]];
else if (bvl23) theta = th_match[1][bnm23[1]];
else if (bvl24) theta = th_match[1][bnm24[1]];
}
else if (vstat[2] == const_(1, 0x1UL)) // ME3 present
{
phi = ph_match[2];
if (bvl13) theta = th_match[2][bnm13[0]];
else if (bvl34) theta = th_match[2][bnm34[1]];
}
else if (vstat[3] == const_(1, 0x1UL)) // ME4 present
{
phi = ph_match[3];
if (bvl14) theta = th_match[3][bnm14[0]];
}
// update rank taking into account available stations after th deltas
// keep straightness as it was
rank = (ph_q, const_s(1, 0x0UL)); // output rank is one bit longer than input, to accommodate ME4 separately
if(rank){std::cout<<"ph_q = "<<ph_q<<" and rank = "<<rank<<" and vstat = "<<vstat<<std::endl;}
rank[0] = vstat[3]; // ME4
rank[1] = vstat[2]; // ME3
rank[3] = vstat[1]; // ME2
rank[5] = vstat[0]; // ME1
if(rank){std::cout<<"ph_q = "<<ph_q<<" and rank = "<<rank<<std::endl;}
// if less than 2 segments, kill rank
if (vstat == const_(4, 0x1UL) || vstat == const_(4, 0x2UL) || vstat == const_(4, 0x4UL) || vstat == const_(4, 0x8UL) || vstat == const_(4, 0x0UL))
rank = 0;
cpattern = cpat_match[0]; // pattern taken from station 1 only at this time
}
endalways(); bd12
(
dth12,
sth12,
dvl12,
bth12,
bsg12,
bvl12,
bnm12
);
bd13
(
dth13,
sth13,
dvl13,
bth13,
bsg13,
bvl13,
bnm13
);
bd14
(
dth14,
sth14,
dvl14,
bth14,
bsg14,
bvl14,
bnm14
);
bd23
(
dth23,
sth23,
dvl23,
bth23,
bsg23,
bvl23,
bnm23
);
bd24
(
dth24,
sth24,
dvl24,
bth24,
bsg24,
bvl24,
bnm24
);
bd34
(
dth34,
sth34,
dvl34,
bth34,
bsg34,
bvl34,
bnm34
);
}
bool ShortcutHandler::eventFilter(QObject *o, QEvent *e)
{
if (!o->isWidgetType())
return QObject::eventFilter(o, e);
QWidget *widget = static_cast<QWidget*>(o);
switch(e->type())
{
case QEvent::KeyPress:
if (Qt::Key_Alt==static_cast<QKeyEvent *>(e)->key())
{
m_altDown = true;
if(qobject_cast<QMenu *>(widget))
{
m_seenAlt.insert(widget);
updateWidget(widget);
if(widget->parentWidget() && widget->parentWidget()->window())
m_seenAlt.insert(widget->parentWidget()->window());
}
else
{
widget = widget->window();
m_seenAlt.insert(widget);
QList<QWidget*> l = widget->findChildren<QWidget*>();
for (int pos = 0;pos < l.size();++pos) {
QWidget *w = l.at(pos);
if (!(w->isWindow() || !w->isVisible())) // || w->style()->styleHint(QStyle::SH_UnderlineShortcut, 0, w)))
updateWidget(w);
}
QList<QMenuBar*> m = widget->findChildren<QMenuBar*>();
for (int i = 0;i < m.size();++i) {
updateWidget(m.at(i));
}
}
}
break;
case QEvent::WindowDeactivate:
case QEvent::KeyRelease:
if (QEvent::WindowDeactivate == e->type() ||
static_cast<QKeyEvent*>(e)->key() == Qt::Key_Alt) {
m_altDown = false;
for (QWidget *widget: const_(m_updated)) {
widget->update();
}
if (!m_updated.contains(widget))
widget->update();
m_seenAlt.clear();
m_updated.clear();
}
break;
case QEvent::Show:
if(qobject_cast<QMenu *>(widget))
{
QWidget *prev=m_openMenus.count() ? m_openMenus.last() : 0L;
m_openMenus.append(widget);
if(m_altDown && prev)
prev->update();
connect(widget, &QWidget::destroyed,
this, &ShortcutHandler::widgetDestroyed);
}
break;
case QEvent::Hide:
if(qobject_cast<QMenu *>(widget))
{
m_seenAlt.remove(widget);
m_updated.remove(widget);
m_openMenus.removeAll(widget);
if(m_altDown)
{
if(m_openMenus.count())
m_openMenus.last()->update();
else if(widget->parentWidget() && widget->parentWidget()->window())
widget->parentWidget()->window()->update();
}
}
break;
case QEvent::Close:
// Reset widget when closing
m_seenAlt.remove(widget);
m_updated.remove(widget);
m_seenAlt.remove(widget->window());
m_openMenus.removeAll(widget);
if(m_altDown)
{
if(m_openMenus.count())
m_openMenus.last()->update();
else if(widget->parentWidget() && widget->parentWidget()->window())
widget->parentWidget()->window()->update();
}
break;
default:
break;
}
return QObject::eventFilter(o, e);
}
void prim_conv11::operator()
(
signal_& quality__io,
signal_& wiregroup__io,
signal_& hstrip__io,
signal_& clctpat__io,
signal_& ph__io,
signal_& th__io,
signal_& vl__io,
signal_& phzvl__io,
signal_& me11a__io,
signal_& clctpat_r__io,
signal_& ph_hit__io,
signal_& th_hit__io,
signal_& sel__io,
signal_& addr__io,
signal_& r_in__io,
signal_& r_out__io,
signal_& we__io,
signal_& clk__io,
signal_& control_clk__io
)
{
if (!built)
{
seg_ch = 2;
bw_ph = 8;
bw_th = 7;
bw_fph = 12;
bw_fth = 8;
bw_wg = 7;
bw_ds = 7;
bw_hs = 8;
pat_w_st3 = 3;
pat_w_st1 = pat_w_st3 + 1;
full_pat_w_st3 = (1 << (pat_w_st3+1)) - 1;
full_pat_w_st1 = (1 << (pat_w_st1+1)) - 1;
padding_w_st1 = full_pat_w_st1 / 2;
padding_w_st3 = full_pat_w_st3 / 2;
red_pat_w_st3 = pat_w_st3 * 2 + 1;
red_pat_w_st1 = pat_w_st1 * 2 + 1;
fold = 4;
th_ch11 = seg_ch*seg_ch;
bw_q = 4;
bw_addr = 7;
ph_raw_w = (1 << pat_w_st3) * 15;
th_raw_w = (1 << bw_th);
max_drift = 3;
bw_phi = 12;
bw_eta = 7;
ph_hit_w = 40+4;
ph_hit_w20 = ph_hit_w;
ph_hit_w10 = 20+4;
th_hit_w = 56 + 8;
endcap = 1;
n_strips = (station <= 1 && cscid <= 2) ? 64 :
(station <= 1 && cscid >= 6) ? 64 : 80;
n_wg = (station <= 1 && cscid <= 3) ? 48 :
(station <= 1 && cscid >= 6) ? 32 :
(station == 2 && cscid <= 3) ? 112 :
(station >= 3 && cscid <= 3) ? 96 : 64;
th_coverage = (station <= 1 && cscid <= 2) ? 45 :
(station <= 1 && cscid >= 6) ? 27 :
(station <= 1 && cscid >= 3) ? 39 :
(station == 2 && cscid <= 2) ? 43 :
(station == 2 && cscid >= 3) ? 56 :
(station == 3 && cscid <= 2) ? 34 :
(station == 3 && cscid >= 3) ? 52 :
(station == 4 && cscid <= 2) ? 28 :
(station == 4 && cscid >= 3) ? 50 : 0;
ph_coverage = (station <= 1 && cscid >= 6) ? 15 : //30 :
(station >= 2 && cscid <= 2) ? 40 : 20;
th_ch = (station <= 1 && cscid <= 2) ? (seg_ch*seg_ch) : seg_ch;
ph_reverse = (endcap == 1 && station >= 3) ? 1 :
(endcap == 2 && station < 3) ? 1 : 0;
th_mem_sz = (1 << bw_addr);
th_corr_mem_sz = (1 << bw_addr);
mult_bw = bw_fph + 11;
ph_zone_bnd1 = (station <= 1 && cscid <= 2) ? 41 :
(station == 2 && cscid <= 2) ? 41 :
(station == 2 && cscid > 2) ? 87 :
(station == 3 && cscid > 2) ? 49 :
(station == 4 && cscid > 2) ? 49 : 127;
ph_zone_bnd2 = (station == 3 && cscid > 2) ? 87 : 127;
zone_overlap = 2;
bwr = 6;
bpow = 6;
cnr = (1 << bpow);
cnrex = ph_raw_w;
build();
// input parameters from MPC
quality.attach(quality__io);
wiregroup.attach(wiregroup__io);
hstrip.attach(hstrip__io);
clctpat.attach(clctpat__io);
sel.attach(sel__io);
addr.attach(addr__io);
r_in.attach(r_in__io);
we.attach(we__io);
clk.attach(clk__io);
control_clk.attach(control_clk__io);
// outputs
// low-precision ph, only for detection
// high-precision ph with displacement correction will be calculated when
// 3 best tracks are found.
ph.attach(ph__io);
// full precision th, but without displacement correction, takes th duplication into account
th.attach(th__io);
// one-bit valid flags
vl.attach(vl__io);
phzvl.attach(phzvl__io);
me11a.attach(me11a__io);
clctpat_r.attach(clctpat_r__io);
// ph and th raw hits
ph_hit.attach(ph_hit__io);
th_hit.attach(th_hit__io);
r_out.attach(r_out__io);
}
pc_id(3,0) = cscid;
pc_id(7,4) = station;
r_out = (sel == const_(2, 0x0UL)) ? params[addr] :
(sel == const_(2, 0x1UL)) ? th_mem[addr] :
(sel == const_(2, 0x2UL)) ? th_corr_mem[addr] : pc_id;
beginalways();
if (posedge (control_clk))
{
if (( (sel) == 0)) { { if (we) params [addr] = r_in; } } else
if (( (sel) == 1)) { { if (we) th_mem [addr] = r_in; } } else
if (( (sel) == 2)) { { if (we) th_corr_mem[addr] = r_in(3,0); } }
}
endalways();
beginalways();
if (posedge (clk))
{
// zero outputs
vl = 0;
phzvl = 0;
for (i = 0; i < seg_ch; i = i+1) { fph[i] = 0; clctpat_r[i] = 0; }
for (i = 0; i < th_ch; i = i+1) th[i] = 0;
ph_hit = 0;
th_hit = 0;
for (i = 0; i < seg_ch; i = i+1)
{
factor[i] = (station <= 1 && cscid <= 2 && hstrip[i] > 127) ? 1707 : // ME1/1a
1301; // ME1/1b
//if(factor[i])
// std::cout<<"factor 11 = "<<factor[i]<<std::endl;
me11a_w[i] = (station <= 1 && cscid <= 2 && hstrip[i] > 127);
if (( (clctpat[i]) == 0)) { { clct_pat_corr = const_(3, 0x0UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 1)) { { clct_pat_corr = const_(3, 0x0UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 2)) { { clct_pat_corr = const_(3, 0x5UL); clct_pat_sign = 1; } } else
if (( (clctpat[i]) == 3)) { { clct_pat_corr = const_(3, 0x5UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 4)) { { clct_pat_corr = const_(3, 0x5UL); clct_pat_sign = 1; } } else
if (( (clctpat[i]) == 5)) { { clct_pat_corr = const_(3, 0x5UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 6)) { { clct_pat_corr = const_(3, 0x2UL); clct_pat_sign = 1; } } else
if (( (clctpat[i]) == 7)) { { clct_pat_corr = const_(3, 0x2UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 8)) { { clct_pat_corr = const_(3, 0x2UL); clct_pat_sign = 1; } } else
if (( (clctpat[i]) == 9)) { { clct_pat_corr = const_(3, 0x2UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 10)) { { clct_pat_corr = const_(3, 0x0UL); clct_pat_sign = 0; } } else { { clct_pat_corr = const_(3, 0x0UL); clct_pat_sign = 0; } }
// reverse clct pattern correction if chamber is reversed
// if (ph_reverse) clct_pat_sign = ~clct_pat_sign;
// convert into 1/8 strips and remove ME1/1a offset (512=128*4)
eight_str[i] = (const_s(2, 0x0UL), hstrip [i], const_s(2, 0x0UL)) - (me11a_w[i] ? 512 : 0);
// clct pattern correction
if (clct_pat_sign == 0) eight_str[i] = eight_str[i] + clct_pat_corr(2,1);
else eight_str[i] = eight_str[i] - clct_pat_corr(2,1);
if (quality[i])
{
vl[i] = 1;
// ph conversion
// for factors 1024 and 2048 the multiplier should be replaced with shifts by synthesizer
mult = eight_str[i] * factor[i];
ph_tmp = mult(mult_bw-1 , 10);
//std::cout<<"ph_tmp = "<<ph_tmp<<std::endl;
ph_init_ix = me11a_w[i] ? const_(3, 2UL) : const_(3, 0UL); // index of ph_init parameter to apply (different for ME11a and b)
//std::cout<<"ph_init_ix = "<<ph_init_ix<<std::endl;
if (ph_reverse)
{
fph[i] = params[ph_init_ix] - ph_tmp;
// set ph raw hits
ph_hit[ph_coverage - ph_tmp(bw_fph-1,5) + params[ph_init_ix + const_(3, 1UL)](7,1)] = 1;
}
else
{
fph[i] = params[ph_init_ix] + ph_tmp;
// set ph raw hits
ph_hit[ph_tmp(bw_fph-1,5) + params[ph_init_ix + const_(3, 1UL)](7,1)] = 1;
/* -----\/----- EXCLUDED -----\/-----
// add hits to take ME11a strip ganging into account
// offsets of 14 and 28 is what I observe from MC. Calculations show 11.6 and 23.2 (???)
if (me11a_w[i])
{
ph_hit[ph_tmp(bw_fph-1,5) + params[2] + 14] = 1;
ph_hit[ph_tmp(bw_fph-1,5) + params[2] + 28] = 1;
}
-----/\----- EXCLUDED -----/\----- */
}
//std::cout<<"estr = "<<eight_str[i]<<", factor = "<<factor[i]<<", ph_rev = "<<ph_reverse<<", ph_tmp = "<<ph_tmp<<std::endl;
//std::cout<<"ph_hit = "<<ph_tmp(bw_fph-1,5) + params[ph_init_ix + const_(3, 1UL)](7,1)<<std::endl;
//std::cout<<"strip = "<<hstrip[i]<<", Id = "<<cscid + 1<<",phinit = "<<(params[ph_init_ix])<<"ph_cov = "<<ph_coverage<<", and phshift = "<<(ph_tmp(bw_fph-1,5))<<", and phdisp = "<<(params[ph_init_ix + const_(3, 1UL)](7,1))<<"\n\n\n";
wg = wiregroup[i];
// th conversion
// call appropriate LUT, it returns th[i] relative to wg0 of that chamber
th_orig = th_mem[wg];
//std::cout<<"wire = "<<wg<<", th_mem[wg] = "<<th_orig<<std::endl;
// need th duplication here
for (j = 0; j < seg_ch; j = j+1)
{
if (quality[j])
{
// calculate correction for each strip number
// index is: (wiregroup(2 MS bits), dblstrip(5-bit for these chambers))
index = (wg(5,4), eight_str[j](8,4));
th_corr = th_corr_mem[index];
//std::cout<<"eightstrip = "<<eight_str[j]<<", eightstrip(8,4) = "<<eight_str[j](8,4)<<", index = "<<index<<", th_corr = "<<th_corr<<std::endl;
//std::cout<<"th_corr = "<<th_corr<<" and th_orig = "<<th_orig<<std::endl;
// apply correction to the corresponding output
if (ph_reverse) th_tmp = (th_orig - th_corr) & const_(6, 0x3fUL);
else th_tmp = (th_orig + th_corr) & const_(6, 0x3fUL);
//std::cout<<"ph_reverse = "<<ph_reverse<<" ";
//if(th_tmp)std::cout<<"th_tmp = "<<th_tmp<<" and thcoverage = "<<th_coverage<<std::endl;
// check that correction did not make invalid value outside chamber coverage
// this will actually take care of both positive and negative illegal values
if (th_tmp < th_coverage)
{
// apply initial th value for that chamber
th[i*seg_ch+j] = th_tmp + params[4];
//std::cout<<"params[4] = "<<params[4]<<"\n";
// th hits
th_hit[th_tmp + params[5]] = 1;
// check which zones ph hits should be applied to
if (th[i*seg_ch+j] <= (ph_zone_bnd1 + zone_overlap)) phzvl[0] = 1;
if (th[i*seg_ch+j] > (ph_zone_bnd2 - zone_overlap)) phzvl[2] = 1;
if (
(th[i*seg_ch+j] > (ph_zone_bnd1 - zone_overlap)) &&
(th[i*seg_ch+j] <= (ph_zone_bnd2 + zone_overlap))
) phzvl[1] = 1;
//std::cout<<"ph_zone_bnd1 = "<<ph_zone_bnd1<<std::endl;
//std::cout<<"phzvl = "<<phzvl<<std::endl;
}
}
}
clctpat_r[i] = clctpat[i]; // just propagate pattern downstream
} // if (quality[i])
ph[i] = fph[i];
//if(fph[i]) std::cout<<"fph["<<i<<"] = "<<fph[i]<<" and vl[i] = "<<vl[i]<<std::endl;
} // for (i = 0; i < seg_ch; i = i+1)
me11a = me11a_w;
}
endalways();
}
void test_sequence_n(Sequence & seq, mpl::int_<0>)
{
// Function Objects
fobj f;
COMPARE_EFFECT(f (), fusion::invoke_procedure(f , seq ));
COMPARE_EFFECT(f (), fusion::invoke_procedure(f , const_(seq)));
// Note: The function object is taken by value, so we request the copy
// to be const with an explicit template argument. We can also request
// the function object to be pased by reference...
COMPARE_EFFECT(const_(f)(), fusion::invoke_procedure<fobj const >(const_(f), seq ));
COMPARE_EFFECT(const_(f)(), fusion::invoke_procedure<fobj const &>(const_(f), const_(seq)));
fobj_nc nc_f;
// ...and we further ensure there is no copying in this case, using a
// noncopyable function object.
COMPARE_EFFECT(nc_f (), fusion::invoke_procedure<fobj_nc &>(nc_f , seq ));
COMPARE_EFFECT(nc_f (), fusion::invoke_procedure<fobj_nc &>(nc_f , const_(seq)));
COMPARE_EFFECT(const_(nc_f)(), fusion::invoke_procedure<fobj_nc const &>(const_(nc_f), seq ));
COMPARE_EFFECT(const_(nc_f)(), fusion::invoke_procedure<fobj_nc const &>(const_(nc_f), const_(seq)));
// Builtin Functions
// Call through ref/ptr to function
COMPARE_EFFECT(nullary(), fusion::invoke_procedure<int (&)()>(nullary, seq));
COMPARE_EFFECT(nullary(), fusion::invoke_procedure(& nullary, seq));
// Call through ptr to member function
// Note: The non-const function members::nullary can't be invoked with
// fusion::join(sv_obj_ctx,seq)), which is const and so is its first element
COMPARE_EFFECT(that.nullary(), fusion::invoke_procedure(& members::nullary, fusion::join(sv_ref_ctx,seq)));
COMPARE_EFFECT(that.nullary(), fusion::invoke_procedure(& members::nullary, fusion::join(sv_ptr_ctx,seq)));
COMPARE_EFFECT(that.nullary(), fusion::invoke_procedure(& members::nullary, fusion::join(sv_spt_ctx,seq)));
COMPARE_EFFECT(that.nullary_c(), fusion::invoke_procedure(& members::nullary_c, fusion::join(sv_obj_ctx,seq)));
COMPARE_EFFECT(that.nullary_c(), fusion::invoke_procedure(& members::nullary_c, fusion::join(sv_ref_ctx,seq)));
COMPARE_EFFECT(that.nullary_c(), fusion::invoke_procedure(& members::nullary_c, fusion::join(sv_ptr_ctx,seq)));
COMPARE_EFFECT(that.nullary_c(), fusion::invoke_procedure(& members::nullary_c, fusion::join(sv_spt_ctx,seq)));
COMPARE_EFFECT(that.nullary_c(), fusion::invoke_procedure(& members::nullary_c, fusion::join(sv_obj_c_ctx,seq)));
COMPARE_EFFECT(that.nullary_c(), fusion::invoke_procedure(& members::nullary_c, fusion::join(sv_ref_c_ctx,seq)));
COMPARE_EFFECT(that.nullary_c(), fusion::invoke_procedure(& members::nullary_c, fusion::join(sv_ptr_c_ctx,seq)));
COMPARE_EFFECT(that.nullary_c(), fusion::invoke_procedure(& members::nullary_c, fusion::join(sv_spt_c_ctx,seq)));
}
void prim_conv::operator()
(
signal_& quality__io,
signal_& wiregroup__io,
signal_& hstrip__io,
signal_& clctpat__io,
signal_& ph__io,
signal_& th__io,
signal_& vl__io,
signal_& phzvl__io,
signal_& me11a__io,
signal_& clctpat_r__io,
signal_& ph_hit__io,
signal_& th_hit__io,
signal_& sel__io,
signal_& addr__io,
signal_& r_in__io,
signal_& r_out__io,
signal_& we__io,
signal_& clk__io,
signal_& control_clk__io
)
{
if (!built)
{
seg_ch = 2;
bw_ph = 8;
bw_th = 7;
bw_fph = 12;
bw_fth = 8;
bw_wg = 7;
bw_ds = 7;
bw_hs = 8;
pat_w_st3 = 3;
pat_w_st1 = pat_w_st3 + 1;
full_pat_w_st3 = (1 << (pat_w_st3+1)) - 1;
full_pat_w_st1 = (1 << (pat_w_st1+1)) - 1;
padding_w_st1 = full_pat_w_st1 / 2;
padding_w_st3 = full_pat_w_st3 / 2;
red_pat_w_st3 = pat_w_st3 * 2 + 1;
red_pat_w_st1 = pat_w_st1 * 2 + 1;
fold = 4;
th_ch11 = seg_ch*seg_ch;
bw_q = 4;
bw_addr = 7;
ph_raw_w = (1 << pat_w_st3) * 15;
th_raw_w = (1 << bw_th);
max_drift = 3;
bw_phi = 12;
bw_eta = 7;
ph_hit_w = 40+4;
ph_hit_w20 = ph_hit_w;
ph_hit_w10 = 20+4;
th_hit_w = 56 + 8;
endcap = 1;
n_strips = (station <= 1 && cscid <= 2) ? 64 :
(station <= 1 && cscid >= 6) ? 64 : 80;
n_wg = (station <= 1 && cscid <= 3) ? 48 :
(station <= 1 && cscid >= 6) ? 32 :
(station == 2 && cscid <= 3) ? 112 :
(station >= 3 && cscid <= 3) ? 96 : 64;
th_coverage = (station <= 1 && cscid <= 2) ? 45 :
(station <= 1 && cscid >= 6) ? 27 :
(station <= 1 && cscid >= 3) ? 39 :
(station == 2 && cscid <= 2) ? 43 :
(station == 2 && cscid >= 3) ? 56 :
(station == 3 && cscid <= 2) ? 34 :
(station == 3 && cscid >= 3) ? 52 :
(station == 4 && cscid <= 2) ? 28 :
(station == 4 && cscid >= 3) ? 50 : 0;
ph_coverage = (station <= 1 && cscid >= 6) ? 15 : //30 :
(station >= 2 && cscid <= 2) ? 40 : 20;
th_ch = (station <= 1 && cscid <= 2) ? (seg_ch*seg_ch) : seg_ch;
ph_reverse = (endcap == 1 && station >= 3) ? 1 :
(endcap == 2 && station < 3) ? 1 : 0;
th_mem_sz = (1 << bw_addr);
th_corr_mem_sz = (1 << bw_addr);
mult_bw = bw_fph + 11;
ph_zone_bnd1 = (station <= 1 && cscid <= 2) ? 41 :
(station == 2 && cscid <= 2) ? 41 :
(station == 2 && cscid > 2) ? 87 :
(station == 3 && cscid > 2) ? 49 :
(station == 4 && cscid > 2) ? 49 : 127;
ph_zone_bnd2 = (station == 3 && cscid > 2) ? 87 : 127;
zone_overlap = 2;
bwr = 6;
bpow = 6;
cnr = (1 << bpow);
cnrex = ph_raw_w;
build();
// input parameters from MPC
quality.attach(quality__io);
wiregroup.attach(wiregroup__io);
hstrip.attach(hstrip__io);
clctpat.attach(clctpat__io);
sel.attach(sel__io);
addr.attach(addr__io);
r_in.attach(r_in__io);
we.attach(we__io);
clk.attach(clk__io);
control_clk.attach(control_clk__io);
// outputs
// phi
ph.attach(ph__io);
// full precision th, but without displacement correction
th.attach(th__io);
// one-bit valid flags
vl.attach(vl__io);
phzvl.attach(phzvl__io);
me11a.attach(me11a__io);
clctpat_r.attach(clctpat_r__io);
// ph and th raw hits
ph_hit.attach(ph_hit__io);
th_hit.attach(th_hit__io);
r_out.attach(r_out__io);
}
pc_id(3,0) = cscid;
pc_id(7,4) = station;
// ME11 special case
// all other stations
r_out = (sel == const_(2, 0x0UL)) ? params[addr] :
(sel == const_(2, 0x1UL)) ? th_mem[addr] : pc_id;
beginalways();
if (posedge (control_clk))
{
if (( (sel) == 0)) { { if (we) params [addr] = r_in; } } else
if (( (sel) == 1)) { { if (we) th_mem [addr] = r_in; } } // case (sel)
}
endalways();
beginalways();
if (posedge (clk))
{
// zero outputs
vl = 0;
phzvl = 0;
for (i = 0; i < seg_ch; i = i+1) { fph[i] = 0; th[i] = 0; clctpat_r[i] = 0; }
ph_hit = 0;
th_hit = 0;
// strip width factor relative to ME234/2
// 1024 == 1
factor = (station <= 1 && cscid >= 6) ? 947 : // ME1/3
1024; // all other chambers
//if(factor)
// std::cout<<"factor else = "<<factor<<std::endl;
for (i = 0; i < seg_ch; i = i+1)
{
me11a_w[i] = 0;
if (( (clctpat[i]) == 0)) { { clct_pat_corr = const_(3, 0x0UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 1)) { { clct_pat_corr = const_(3, 0x0UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 2)) { { clct_pat_corr = const_(3, 0x5UL); clct_pat_sign = 1; } } else
if (( (clctpat[i]) == 3)) { { clct_pat_corr = const_(3, 0x5UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 4)) { { clct_pat_corr = const_(3, 0x5UL); clct_pat_sign = 1; } } else
if (( (clctpat[i]) == 5)) { { clct_pat_corr = const_(3, 0x5UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 6)) { { clct_pat_corr = const_(3, 0x2UL); clct_pat_sign = 1; } } else
if (( (clctpat[i]) == 7)) { { clct_pat_corr = const_(3, 0x2UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 8)) { { clct_pat_corr = const_(3, 0x2UL); clct_pat_sign = 1; } } else
if (( (clctpat[i]) == 9)) { { clct_pat_corr = const_(3, 0x2UL); clct_pat_sign = 0; } } else
if (( (clctpat[i]) == 10)) { { clct_pat_corr = const_(3, 0x0UL); clct_pat_sign = 0; } } else { { clct_pat_corr = const_(3, 0x0UL); clct_pat_sign = 0; } }
// reverse clct pattern correction if chamber is reversed
// if (ph_reverse) clct_pat_sign = ~clct_pat_sign;
// 10 deg chambers
if (station < 2 || cscid > 2)
{
eight_str[i] = (const_s(2, 0x0UL), hstrip [i], const_s(2, 0x0UL)); // full precision, uses only 2 bits of clct pattern correction
if (clct_pat_sign == 0) eight_str[i] = eight_str[i] + clct_pat_corr(2,1);
else eight_str[i] = eight_str[i] - clct_pat_corr(2,1);
}
else
{
// 20 deg chambers
eight_str[i] = (const_s(1, 0x0UL), hstrip [i], const_s(3, 0x0UL)); // multiply by 2, uses all 3 bits of pattern correction
if (clct_pat_sign == 0) eight_str[i] = eight_str[i] + clct_pat_corr;
else eight_str[i] = eight_str[i] - clct_pat_corr;
}
if (quality[i])
{
vl[i] = 1;
// ph conversion
// for factors 1024 and 2048 the multiplier should be replaced with shifts by synthesizer
mult = eight_str[i] * factor;
ph_tmp = mult(mult_bw-1 , 10);
if (ph_reverse)
{
fph[i] = params[0] - ph_tmp;
// set ph raw hits
ph_hit[ph_coverage - ph_tmp(bw_fph-1,5) + params[2](7,1)] = 1;
}
else
{
fph[i] = params[0] + ph_tmp;
// set ph raw hits
ph_hit[ph_tmp(bw_fph-1,5) + params[2](7,1)] = 1;
}
if(fph[i])
std::cout<<"fph["<<i<<"] = "<<fph[i]<<" and vl[i] = "<<vl[i]<<std::endl;
//std::cout<<"estr = "<<eight_str[i]<<", factor = "<<factor<<", ph_rev = "<<ph_reverse<<", ph_tmp = "<<ph_tmp<<std::endl;
//std::cout<<"strip = "<<hstrip[i]<<", Id = "<<cscid + 1<<",phinit = "<<params[0]<<"ph_cov = "<<ph_coverage<<", and phshift = "<<ph_tmp(bw_fph-1,5)<<", and params[2] = "<<params[2](7,1)<<"\n\n\n";
wg = wiregroup[i];
// th conversion
th_tmp = th_mem[wg];
th[i] = th_tmp + params[1];
th_hit[th_tmp + params[3]] = 1;
// check which zones ph hits should be applied to
if (th[i] <= (ph_zone_bnd1 + zone_overlap)) phzvl[0] = 1;
if (th[i] > (ph_zone_bnd2 - zone_overlap)) phzvl[2] = 1;
if (
(th[i] > (ph_zone_bnd1 - zone_overlap)) &&
(th[i] <= (ph_zone_bnd2 + zone_overlap))
) phzvl[1] = 1;
clctpat_r[i] = clctpat[i]; // just propagate pattern downstream
std::cout<<"phzvl = "<<phzvl<<std::endl;
} // if (quality[i])
ph[i] = fph[i];
}
me11a = 0;
}
endalways();
}
