Interleaving fix

openair1/PHY/NR_TRANSPORT/nr_pbch.c

@@ -206,7 +206,7 @@ int nr_generate_pbch(NR_gNB_PBCH *pbch,
                      NR_DL_FRAME_PARMS *frame_parms)
 {
 
-  int j,k,l,m;
+  int k,l,m;
   int16_t a;
   int16_t mod_pbch_e[NR_POLAR_PBCH_E];
   uint8_t idx=0;
@@ -246,16 +246,16 @@ int nr_generate_pbch(NR_gNB_PBCH *pbch,
 #endif
 
     // Payload interleaving
-  uint8_t *in = &pbch->pbch_a[3];
-  uint8_t *out = &pbch->pbch_a_interleaved[3];
-  for (int i=0; i<32; i++) {
-    j = i&7;
-    if (!j) {
-      in--;
-      out--;
-    }
-    (*out) |= (((*in)>>j)&1)<<((nr_pbch_payload_interleaver(i))&7);
-  }
+  uint32_t in=0, out=0;
+  for (int i=0; i<NR_POLAR_PBCH_PAYLOAD_BITS>>3; i++)
+    in |= (uint32_t)(pbch->pbch_a[i]<<((3-i)<<3));
+
+  for (int i=0; i<32; i++)
+    out |= ((in>>i)&1)<<(nr_pbch_payload_interleaver(i));
+
+  for (int i=0; i<NR_POLAR_PBCH_PAYLOAD_BITS>>3; i++)
+    pbch->pbch_a_interleaved[i] = (uint8_t)((out>>(i<<3))&0xff);
+
 #ifdef DEBUG_PBCH_ENCODING
   printf("Interleaving:\n");
   for (int i=0; i<4; i++)