@ -52,6 +52,7 @@ rrc::rrc()
{
n310_cnt = 0 ;
n311_cnt = 0 ;
serving_cell = new cell_t ( ) ;
}
static void liblte_rrc_handler ( void * ctx , char * str ) {
@ -89,8 +90,6 @@ void rrc::init(phy_interface_rrc *phy_,
state = RRC_STATE_IDLE ;
si_acquire_state = SI_ACQUIRE_IDLE ;
bzero ( known_cells , MAX_KNOWN_CELLS * sizeof ( cell_t ) ) ;
thread_running = true ;
start ( ) ;
@ -210,13 +209,13 @@ void rrc::run_thread() {
* Cell is selected when all SIBs downloaded or applied .
*/
if ( phy - > sync_status ( ) ) {
if ( ! current _cell- > has_valid_sib1 ) {
if ( ! serving _cell- > has_valid_sib1 ) {
si_acquire_state = SI_ACQUIRE_SIB1 ;
sysinfo_index = 0 ;
} else if ( ! current _cell- > has_valid_sib2 ) {
} else if ( ! serving _cell- > has_valid_sib2 ) {
si_acquire_state = SI_ACQUIRE_SIB2 ;
} else {
apply_sib2_configs ( & current _cell- > sib2 ) ;
apply_sib2_configs ( & serving _cell- > sib2 ) ;
si_acquire_state = SI_ACQUIRE_IDLE ;
state = RRC_STATE_CELL_SELECTED ;
}
@ -228,6 +227,7 @@ void rrc::run_thread() {
rrc_log - > info ( " RRC Cell Selecting: timeout expired. Starting Cell Search... \n " ) ;
plmn_select_timeout = 0 ;
select_cell_timeout = 0 ;
serving_cell - > in_sync = false ;
phy - > cell_search_start ( ) ;
}
}
@ -254,7 +254,7 @@ void rrc::run_thread() {
} else {
rrc_log - > info ( " RRC Cell Selected: Starting paging and going to IDLE... \n " ) ;
mac - > pcch_start_rx ( ) ;
state = RRC_STATE_ ID LE;
state = RRC_STATE_ LEAVE_CONNECTED ;
}
break ;
case RRC_STATE_CONNECTING :
@ -287,25 +287,7 @@ void rrc::run_thread() {
break ;
case RRC_STATE_LEAVE_CONNECTED :
usleep ( 60000 ) ;
rrc_log - > console ( " RRC IDLE \n " ) ;
rrc_log - > info ( " Leaving RRC_CONNECTED state \n " ) ;
drb_up = false ;
measurements . reset ( ) ;
pdcp - > reset ( ) ;
rlc - > reset ( ) ;
phy - > reset ( ) ;
mac - > reset ( ) ;
set_phy_default ( ) ;
set_mac_default ( ) ;
mac_timers - > timer_get ( t310 ) - > stop ( ) ;
mac_timers - > timer_get ( t311 ) - > stop ( ) ;
if ( phy - > sync_status ( ) ) {
// Instruct MAC to look for P-RNTI
mac - > pcch_start_rx ( ) ;
// Instruct PHY to measure serving cell for cell reselection
phy - > meas_start ( phy - > get_current_earfcn ( ) , phy - > get_current_pci ( ) ) ;
}
leave_connected ( ) ;
// Move to RRC_IDLE
state = RRC_STATE_IDLE ;
break ;
@ -370,19 +352,19 @@ void rrc::run_si_acquisition_procedure()
break ;
case SI_ACQUIRE_SIB2 :
// Instruct MAC to look for next SIB
if ( sysinfo_index < current _cell- > sib1 . N_sched_info ) {
si_win_len = liblte_rrc_si_window_length_num [ current _cell- > sib1 . si_window_length ] ;
if ( sysinfo_index < serving _cell- > sib1 . N_sched_info ) {
si_win_len = liblte_rrc_si_window_length_num [ serving _cell- > sib1 . si_window_length ] ;
x = sysinfo_index * si_win_len ;
sf = x % 10 ;
offset = x / 10 ;
tti = mac - > get_current_tti ( ) ;
period = liblte_rrc_si_periodicity_num [ current _cell- > sib1 . sched_info [ sysinfo_index ] . si_periodicity ] ;
period = liblte_rrc_si_periodicity_num [ serving _cell- > sib1 . sched_info [ sysinfo_index ] . si_periodicity ] ;
si_win_start = sib_start_tti ( tti , period , offset , sf ) ;
if ( tti > last_win_start + 10 ) {
last_win_start = si_win_start ;
si_win_len = liblte_rrc_si_window_length_num [ current _cell- > sib1 . si_window_length ] ;
si_win_len = liblte_rrc_si_window_length_num [ serving _cell- > sib1 . si_window_length ] ;
mac - > bcch_start_rx ( si_win_start , si_win_len ) ;
rrc_log - > debug ( " Instructed MAC to search for system info, win_start=%d, win_len=%d \n " ,
@ -421,19 +403,15 @@ void rrc::run_si_acquisition_procedure()
* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
uint16_t rrc : : get_mcc ( ) {
if ( current_cell ) {
if ( current_cell - > sib1 . N_plmn_ids > 0 ) {
return current_cell - > sib1 . plmn_id [ 0 ] . id . mcc ;
}
if ( serving_cell - > sib1 . N_plmn_ids > 0 ) {
return serving_cell - > sib1 . plmn_id [ 0 ] . id . mcc ;
}
return 0 ;
}
uint16_t rrc : : get_mnc ( ) {
if ( current_cell ) {
if ( current_cell - > sib1 . N_plmn_ids > 0 ) {
return current_cell - > sib1 . plmn_id [ 0 ] . id . mnc ;
}
if ( serving_cell - > sib1 . N_plmn_ids > 0 ) {
return serving_cell - > sib1 . plmn_id [ 0 ] . id . mnc ;
}
return 0 ;
}
@ -468,188 +446,263 @@ void rrc::plmn_select_rrc(LIBLTE_RRC_PLMN_IDENTITY_STRUCT plmn_id) {
// Sort cells according to RSRP
selected_plmn_id = plmn_id ;
last_selected_cell = - 1 ;
select_cell_timeout = 0 ;
state = RRC_STATE_CELL_SELECTING ;
select_next_cell_in_plmn ( ) ;
}
} else {
rrc_log - > warning ( " Requested PLMN select in incorrect state %s \n " , rrc_state_text [ state ] ) ;
}
}
void rrc : : select_next_cell_in_plmn ( ) {
for ( uint32_t i = last_selected_cell + 1 ; i < MAX_KNOWN_CELLS & & known_cells [ i ] . earfcn ; i + + ) {
for ( uint32_t j = 0 ; j < known_cells [ i ] . sib1 . N_plmn_ids ; j + + ) {
if ( known_cells [ i ] . sib1 . plmn_id [ j ] . id . mcc = = selected_plmn_id . mcc | |
known_cells [ i ] . sib1 . plmn_id [ j ] . id . mnc = = selected_plmn_id . mnc ) {
rrc_log - > info ( " Selecting cell PCI=%d, EARFCN=%d, Cell ID=0x%x \n " ,
known_cells [ i ] . phy_cell . id , known_cells [ i ] . earfcn ,
known_cells [ i ] . sib1 . cell_id ) ;
rrc_log - > console ( " Select cell: PCI=%d, EARFCN=%d, Cell ID=0x%x \n " ,
known_cells [ i ] . phy_cell . id , known_cells [ i ] . earfcn ,
known_cells [ i ] . sib1 . cell_id ) ;
// Check that cell satisfies S criteria
if ( known_cells [ i ] . in_sync ) { // %% rsrp > S dbm
// Try to select Cell
if ( phy - > cell_select ( known_cells [ i ] . earfcn , known_cells [ i ] . phy_cell ) )
void rrc : : set_serving_cell ( uint32_t earfcn , uint32_t pci ) {
int cell_idx = find_neighbour_cell ( earfcn , pci ) ;
if ( cell_idx > = 0 ) {
set_serving_cell ( cell_idx ) ;
} else {
rrc_log - > error ( " Setting serving cell: Unkonwn cell with earfcn=%d, PCI=%d \n " , earfcn , pci ) ;
}
}
void rrc : : set_serving_cell ( uint32_t cell_idx ) {
if ( cell_idx < neighbour_cells . size ( ) )
{
last_selected_cell = i ;
current_cell = & known_cells [ i ] ;
rrc_log - > info ( " Selected cell PCI=%d, EARFCN=%d, Cell ID=0x%x, addr=0x%x \n " ,
current_cell - > phy_cell . id , current_cell - > earfcn ,
current_cell - > sib1 . cell_id , current_cell ) ;
// Remove future serving cell from neighbours to make space for current serving cell
cell_t * new_serving_cell = neighbour_cells [ cell_idx ] ;
if ( ! new_serving_cell ) {
rrc_log - > error ( " Setting serving cell. Index %d is empty \n " , cell_idx ) ;
return ;
}
neighbour_cells . erase ( std : : remove ( neighbour_cells . begin ( ) , neighbour_cells . end ( ) , neighbour_cells [ cell_idx ] ) , neighbour_cells . end ( ) ) ;
// Move serving cell to neighbours list
if ( serving_cell - > is_valid ( ) ) {
// Make sure it does not exist already
int serving_idx = find_neighbour_cell ( serving_cell - > earfcn , serving_cell - > phy_cell . id ) ;
if ( serving_idx > = 0 & & ( uint32_t ) serving_idx < neighbour_cells . size ( ) ) {
printf ( " Error serving cell is already in the neighbour list. Removing it \n " ) ;
neighbour_cells . erase ( std : : remove ( neighbour_cells . begin ( ) , neighbour_cells . end ( ) , neighbour_cells [ serving_idx ] ) , neighbour_cells . end ( ) ) ;
}
// If not in the list, add it to the list of neighbours (sorted inside the function)
if ( ! add_neighbour_cell ( serving_cell ) ) {
rrc_log - > info ( " Serving cell not added to list of neighbours. Worse than current neighbours \n " ) ;
}
}
// Set new serving cell
serving_cell = new_serving_cell ;
rrc_log - > info ( " Setting serving cell idx=%d, earfcn=%d, PCI=%d, nof_neighbours=%d \n " ,
cell_idx , serving_cell - > earfcn , serving_cell - > phy_cell . id , neighbour_cells . size ( ) ) ;
} else {
rrc_log - > warning ( " Selecting cell EARFCN=%d, Cell ID=0x%x. \n " ,
known_cells [ i ] . earfcn , known_cells [ i ] . sib1 . cell_id ) ;
rrc_log - > error ( " Setting invalid serving cell idx %d \n " , cell_idx ) ;
}
}
void rrc : : select_next_cell_in_plmn ( ) {
// Neighbour cells are sorted in descending order of RSRP
for ( uint32_t i = 0 ; i < neighbour_cells . size ( ) ; i + + ) {
if ( neighbour_cells [ i ] - > plmn_equals ( selected_plmn_id ) & &
neighbour_cells [ i ] - > in_sync ) // matches S criteria
{
// Try to select Cell
if ( phy - > cell_select ( neighbour_cells [ i ] - > earfcn , neighbour_cells [ i ] - > phy_cell ) ) {
set_serving_cell ( i ) ;
rrc_log - > info ( " Selected cell PCI=%d, EARFCN=%d, Cell ID=0x%x \n " ,
serving_cell - > phy_cell . id , serving_cell - > earfcn ,
serving_cell - > sib1 . cell_id ) ;
rrc_log - > console ( " Selected cell PCI=%d, EARFCN=%d, Cell ID=0x%x \n " ,
serving_cell - > phy_cell . id , serving_cell - > earfcn ,
serving_cell - > sib1 . cell_id ) ;
} else {
// Set to out-of-sync if can't synchronize
neighbour_cells [ i ] - > in_sync = false ;
rrc_log - > warning ( " Selecting cell EARFCN=%d, Cell ID=0x%x. \n " ,
neighbour_cells [ i ] - > earfcn , neighbour_cells [ i ] - > sib1 . cell_id ) ;
}
return ;
}
}
rrc_log - > info ( " No more known cells. Starting again \n " ) ;
last_selected_cell = - 1 ;
}
void rrc : : new_phy_meas ( float rsrp , float rsrq , uint32_t tti , uint32_t earfcn , uint32_t pci ) {
void rrc : : new_phy_meas ( float rsrp , float rsrq , uint32_t tti , int earfcn_i , int pci_i ) {
if ( earfcn_i < 0 | | pci_i < 0 ) {
earfcn_i = serving_cell - > earfcn ;
pci_i = serving_cell - > phy_cell . id ;
}
uint32_t earfcn = ( uint32_t ) earfcn_i ;
uint32_t pci = ( uint32_t ) pci_i ;
// Measurements in RRC_CONNECTED go through measuremnt class to log reports etc.
if ( state ! = RRC_STATE_IDLE ) {
measurements . new_phy_meas ( earfcn , pci , rsrp , rsrq , tti ) ;
// Measurements in RRC_IDLE update serving cell and check for reselection
} else {
// If measurement is of the serving cell, evaluate cell reselection criteria
if ( ( earfcn = = phy - > get_current_earfcn ( ) & & pci = = phy - > get_current_pci ( ) ) | | ( earfcn = = 0 & & pci = = 0 ) ) {
// Update serving cell
if ( serving_cell - > equals ( earfcn , pci ) ) {
cell_reselection_eval ( rsrp , rsrq ) ;
current_cell - > rsrp = rsrp ;
rrc_log - > info ( " MEAS: New measurement serving cell, rsrp=%f, rsrq=%f, tti=%d \n " , rsrp , rsrq , tti ) ;
} else {
// Add/update cell measurement
srslte_cell_t cell ;
phy - > get_current_cell ( & cell , NULL ) ;
cell . id = pci ;
add_new_cell ( earfcn , cell , rsrp ) ;
serving_cell - > rsrp = rsrp ;
rrc_log - > info ( " MEAS: New measurement serving cell in IDLE, rsrp=%f, rsrq=%f, tti=%d \n " , rsrp , rsrq , tti ) ;
rrc_log - > info ( " MEAS: New measurement PCI=%d, RSRP=%.1f dBm. \n " , pci , rsrp ) ;
// Or update/add neighbour cell
} else {
if ( add_neighbour_cell ( earfcn , pci , rsrp ) ) {
rrc_log - > info ( " MEAS: New measurement neighbour in IDLE, PCI=%d, RSRP=%.1f dBm. \n " , pci , rsrp ) ;
} else {
rrc_log - > info ( " MEAS: Neighbour Cell in IDLE PCI=%d, RSRP=%.1f dBm not added. Worse than current neighbours \n " , pci , rsrp ) ;
}
}
srslte_cell_t best_cell ;
uint32_t best_cell_idx = find_best_cell ( phy - > get_current_earfcn ( ) , & best_cell ) ;
// Verify cell selection criteria
if ( cell_selection_eval ( known_cells [ best_cell_idx ] . rsrp ) & &
known_cells [ best_cell_idx ] . rsrp > current_cell - > rsrp + 5 & &
best_cell . id ! = phy - > get_current_pci ( ) )
// Verify cell selection criteria with strongest neighbour cell (always first)
if ( cell_selection_eval ( neighbour_cells [ 0 ] - > rsrp ) & &
neighbour_cells [ 0 ] - > rsrp > serving_cell - > rsrp + 5 )
{
rrc_log - > info ( " Selecting best neighbour cell PCI=%d, rsrp=%.1f dBm \n " , best_cell . id , known_cells [ best_cell_idx ] . rsrp ) ;
set_serving_cell ( 0 ) ;
rrc_log - > info ( " Selecting best neighbour cell PCI=%d, rsrp=%.1f dBm \n " , serving_cell - > phy_cell . id , serving_cell - > rsrp ) ;
state = RRC_STATE_CELL_SELECTING ;
current_cell = & known_cells [ best_cell_idx ] ;
phy - > cell_select ( phy - > get_current_earfcn ( ) , best_cell ) ;
phy - > cell_select ( serving_cell - > earfcn , serving_cell - > phy_cell ) ;
}
}
}
void rrc : : cell_found ( uint32_t earfcn , srslte_cell_t phy_cell , float rsrp ) {
// find if cell_id-earfcn combination already exists
for ( uint32_t i = 0 ; i < MAX_KNOWN_CELLS & & known_cells [ i ] . earfcn ; i + + ) {
if ( earfcn = = known_cells [ i ] . earfcn & & phy_cell . id = = known_cells [ i ] . phy_cell . id ) {
current_cell = & known_cells [ i ] ;
current_cell - > rsrp = rsrp ;
current_cell - > in_sync = true ;
rrc_log - > info ( " Updating cell EARFCN=%d, PCI=%d, RSRP=%.1f dBm \n " , current_cell - > earfcn ,
current_cell - > phy_cell . id , current_cell - > rsrp ) ;
bool found = false ;
int cell_idx = - 1 ;
if ( ! current_cell - > has_valid_sib1 ) {
if ( serving_cell - > equals ( earfcn , phy_cell . id ) ) {
serving_cell - > rsrp = rsrp ;
serving_cell - > in_sync = true ;
found = true ;
} else {
// Check if cell is in our list of neighbour cells
cell_idx = find_neighbour_cell ( earfcn , phy_cell . id ) ;
if ( cell_idx > = 0 ) {
set_serving_cell ( cell_idx ) ;
serving_cell - > rsrp = rsrp ;
serving_cell - > in_sync = true ;
found = true ;
}
}
if ( found ) {
rrc_log - > info ( " Updating %s cell EARFCN=%d, PCI=%d, RSRP=%.1f dBm \n " ,
cell_idx > = 0 ? " neighbour " : " serving " ,
serving_cell - > earfcn ,
serving_cell - > phy_cell . id ,
serving_cell - > rsrp ) ;
if ( ! serving_cell - > has_valid_sib1 ) {
si_acquire_state = SI_ACQUIRE_SIB1 ;
} else if ( state = = RRC_STATE_PLMN_SELECTION ) {
for ( uint32_t j = 0 ; j < current_cell - > sib1 . N_plmn_ids ; j + + ) {
nas - > plmn_found ( current_cell - > sib1 . plmn_id [ j ] . id , current_cell - > sib1 . tracking_area_code ) ;
for ( uint32_t j = 0 ; j < serving _cell- > sib1 . N_plmn_ids ; j + + ) {
nas - > plmn_found ( serving _cell- > sib1 . plmn_id [ j ] . id , serving _cell- > sib1 . tracking_area_code ) ;
}
usleep ( 5000 ) ;
phy - > cell_search_next ( ) ;
}
return ;
}
}
} else {
// add to list of known cells and set current_cell
current_cell = add_new_cell ( earfcn , phy_cell , rsrp ) ;
if ( ! current_cell ) {
current_cell = & known_cells [ 0 ] ;
rrc_log - > error ( " Couldn't add new cell \n " ) ;
return ;
}
if ( ! add_neighbour_cell ( earfcn , phy_cell , rsrp ) ) {
rrc_log - > info ( " No more space for neighbour cells (detected cell RSRP=%.1f dBm worse than current %d neighbours) \n " ,
rsrp , NOF_NEIGHBOUR_CELLS ) ;
usleep ( 5000 ) ;
phy - > cell_search_next ( ) ;
} else {
set_serving_cell ( earfcn , phy_cell . id ) ;
si_acquire_state = SI_ACQUIRE_SIB1 ;
rrc_log - > info ( " New Cell: PCI=%d, PRB=%d, Ports=%d, EARFCN=%d, RSRP=%.1f dBm , addr=0x%x \n " ,
current_cell - > phy_cell . id , current_cell - > phy_cell . nof_prb , current - > phy_cell . nof_ports ,
current_cell - > earfcn , current_cell - > rsrp , current_cell ) ;
rrc_log - > info ( " New Cell: PCI=%d, PRB=%d, Ports=%d, EARFCN=%d, RSRP=%.1f dBm \n " ,
serving_cell - > phy_cell . id , serving_cell - > phy_cell . nof_prb , serving _cell- > phy_cell . nof_ports ,
serving_cell - > earfcn , serving_cell - > rsrp ) ;
}
uint32_t rrc : : find_best_cell ( uint32_t earfcn , srslte_cell_t * cell ) {
float best_rsrp = - INFINITY ;
uint32_t best_cell_idx = 0 ;
for ( int i = 0 ; i < MAX_KNOWN_CELLS ; i + + ) {
if ( known_cells [ i ] . earfcn = = earfcn ) {
if ( known_cells [ i ] . rsrp > best_rsrp ) {
best_rsrp = known_cells [ i ] . rsrp ;
best_cell_idx = i ;
}
}
bool sort_rsrp ( cell_t * u1 , cell_t * u2 ) {
return ! u1 - > greater ( u2 ) ;
}
if ( cell ) {
memcpy ( cell , & known_cells [ best_cell_idx ] . phy_cell , sizeof ( srslte_cell_t ) ) ;
// Sort neighbour cells by decreasing order of RSRP
void rrc : : sort_neighbour_cells ( ) {
for ( uint32_t i = 1 ; i < neighbour_cells . size ( ) ; i + + ) {
if ( neighbour_cells [ i ] - > in_sync = = false ) {
rrc_log - > info ( " Removing neighbour cell PCI=%d, out_of_sync \n " , neighbour_cells [ i ] - > phy_cell . id ) ;
neighbour_cells . erase ( std : : remove ( neighbour_cells . begin ( ) , neighbour_cells . end ( ) , neighbour_cells [ i ] ) , neighbour_cells . end ( ) ) ;
}
return best_cell_idx ;
}
rrc : : cell_t * rrc : : add_new_cell ( uint32_t earfcn , srslte_cell_t phy_cell , float rsrp ) {
if ( earfcn = = 0 ) {
return NULL ;
std : : sort ( neighbour_cells . begin ( ) , neighbour_cells . end ( ) , sort_rsrp ) ;
char ordered [ 512 ] ;
int n = 0 ;
n + = snprintf ( ordered , 512 , " [pci=%d, rsrsp=%.2f " , neighbour_cells [ 0 ] - > phy_cell . id , neighbour_cells [ 0 ] - > rsrp ) ;
for ( uint32_t i = 1 ; i < neighbour_cells . size ( ) ; i + + ) {
n + = snprintf ( & ordered [ n ] , 512 - n , " | pci=%d, rsrp=%.2f " , neighbour_cells [ i ] - > phy_cell . id , neighbour_cells [ i ] - > rsrp ) ;
}
int idx = find_cell_idx ( earfcn , phy_cell . id ) ;
if ( idx > = 0 ) {
known_cells [ idx ] . rsrp = rsrp ;
return & known_cells [ idx ] ;
rrc_log - > info ( " Sorted neighbour cells: %s] \n " , ordered ) ;
}
// if does not exist, find empty slot
int i = 0 ;
while ( i < MAX_KNOWN_CELLS & & known_cells [ i ] . earfcn ) {
i + + ;
bool rrc : : add_neighbour_cell ( cell_t * new_cell ) {
bool ret = false ;
if ( neighbour_cells . size ( ) < NOF_NEIGHBOUR_CELLS - 1 ) {
ret = true ;
} else if ( ! neighbour_cells [ neighbour_cells . size ( ) - 1 ] - > greater ( new_cell ) ) {
// Delete old one
delete neighbour_cells [ neighbour_cells . size ( ) - 1 ] ;
neighbour_cells . erase ( std : : remove ( neighbour_cells . begin ( ) , neighbour_cells . end ( ) , neighbour_cells [ neighbour_cells . size ( ) - 1 ] ) , neighbour_cells . end ( ) ) ;
ret = true ;
}
if ( i = = MAX_KNOWN_CELLS ) {
rrc_log - > error ( " Can't add more cells \n " ) ;
return NULL ;
if ( ret ) {
neighbour_cells . push_back ( new_cell ) ;
}
rrc_log - > info ( " Added neighbour cell EARFCN=%d, PCI=%d, nof_neighbours=%d \n " ,
new_cell - > earfcn , new_cell - > phy_cell . id , neighbour_cells . size ( ) ) ;
sort_neighbour_cells ( ) ;
return ret ;
}
known_cells [ i ] . phy_cell = phy_cell ;
known_cells [ i ] . rsrp = rsrp ;
known_cells [ i ] . earfcn = earfcn ;
known_cells [ i ] . has_valid_sib1 = false ;
known_cells [ i ] . has_valid_sib2 = false ;
known_cells [ i ] . has_valid_sib3 = false ;
return & known_cells [ i ] ;
// If only neighbour PCI is provided, copy full cell from serving cell
bool rrc : : add_neighbour_cell ( uint32_t earfcn , uint32_t pci , float rsrp ) {
srslte_cell_t serving_phy ;
serving_phy = serving_cell - > phy_cell ;
serving_phy . id = pci ;
return add_neighbour_cell ( earfcn , serving_phy , rsrp ) ;
}
void rrc : : add_neighbour_cell ( uint32_t earfcn , uint32_t pci , float rsrp ) {
int idx = find_cell_idx ( earfcn , pci ) ;
if ( idx > = 0 ) {
known_cells [ idx ] . rsrp = rsrp ;
return ;
bool rrc : : add_neighbour_cell ( uint32_t earfcn , srslte_cell_t phy_cell , float rsrp ) {
if ( earfcn = = 0 ) {
earfcn = serving_cell - > earfcn ;
}
// First check if already exists
int cell_idx = find_neighbour_cell ( earfcn , phy_cell . id ) ;
rrc_log - > info ( " Adding PCI=%d, earfcn=%d, cell_idx=%d \n " , phy_cell . id , earfcn , cell_idx ) ;
// If exists, update RSRP, sort again and return
if ( cell_idx > = 0 ) {
neighbour_cells [ cell_idx ] - > rsrp = rsrp ;
sort_neighbour_cells ( ) ;
return true ;
}
rrc_log - > info ( " Added neighbour cell earfcn=%d, pci=%d, rsrp=%f \n " , earfcn , pci , rsrp ) ;
// If not, create a new one
cell_t * new_cell = new cell_t ( phy_cell , earfcn , rsrp ) ;
srslte_cell_t cell ;
cell = current_cell - > phy_cell ;
cell . id = pci ;
add_new_cell ( earfcn , cell , rsrp ) ;
return add_neighbour_cell ( new_cell ) ;
}
int rrc : : find_ cell_idx ( uint32_t earfcn , uint32_t pci ) {
for ( uint32_t i = 0 ; i < MAX_KNOWN_CELLS ; i + + ) {
if ( earfcn = = known_cells [ i ] . earfcn & & pci = = known_cells [ i ] . phy_cell . id ) {
int rrc : : find_neighbour_cell ( uint32_t earfcn , uint32_t pci ) {
for ( uint32_t i = 0 ; i < neighbour_cells. size ( ) ; i + + ) {
if ( neighbour_cells[ i ] - > equals ( earfcn , pci ) ) {
return ( int ) i ;
}
}
@ -720,9 +773,10 @@ float rrc::get_squal(float Qqualmeas) {
*
* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
// Detection of physical layer problems (5.3.11.1)
// Detection of physical layer problems in RRC_CONNECTED (5.3.11.1)
void rrc : : out_of_sync ( ) {
current_cell - > in_sync = false ;
serving_cell - > in_sync = false ;
if ( state = = RRC_STATE_CONNECTED ) {
if ( ! mac_timers - > timer_get ( t311 ) - > is_running ( ) & & ! mac_timers - > timer_get ( t310 ) - > is_running ( ) ) {
n310_cnt + + ;
if ( n310_cnt = = N310 ) {
@ -733,11 +787,14 @@ void rrc::out_of_sync() {
rrc_log - > info ( " Detected %d out-of-sync from PHY. Trying to resync. Starting T310 timer \n " , N310 ) ;
}
}
} else {
phy - > sync_reset ( ) ;
}
}
// Recovery of physical layer problems (5.3.11.2)
void rrc : : in_sync ( ) {
current _cell- > in_sync = true ;
serving _cell- > in_sync = true ;
if ( mac_timers - > timer_get ( t310 ) - > is_running ( ) ) {
n311_cnt + + ;
if ( n311_cnt = = N311 ) {
@ -861,7 +918,7 @@ void rrc::send_con_restablish_request(LIBLTE_RRC_CON_REEST_REQ_CAUSE_ENUM cause,
uint8_t * msg_ptr = varShortMAC ;
// ASN.1 encode byte-aligned VarShortMAC-Input
liblte_rrc_pack_cell_identity_ie ( current _cell- > sib1 . cell_id , & msg_ptr ) ;
liblte_rrc_pack_cell_identity_ie ( serving _cell- > sib1 . cell_id , & msg_ptr ) ;
msg_ptr = & varShortMAC [ 4 ] ;
liblte_rrc_pack_phys_cell_id_ie ( phy - > get_current_pci ( ) , & msg_ptr ) ;
msg_ptr = & varShortMAC [ 4 + 2 ] ;
@ -869,7 +926,7 @@ void rrc::send_con_restablish_request(LIBLTE_RRC_CON_REEST_REQ_CAUSE_ENUM cause,
srslte_bit_pack_vector ( varShortMAC , varShortMAC_packed , ( 4 + 2 + 4 ) * 8 ) ;
rrc_log - > info ( " Generated varShortMAC: cellId=0x%x, PCI=%d, rnti=%d \n " ,
current _cell- > sib1 . cell_id , phy - > get_current_pci ( ) , crnti ) ;
serving _cell- > sib1 . cell_id , phy - > get_current_pci ( ) , crnti ) ;
// Compute MAC-I
uint8_t mac_key [ 4 ] ;
@ -997,9 +1054,9 @@ bool rrc::ho_prepare() {
if ( pending_mob_reconf ) {
rrc_log - > info ( " Processing HO command to target PCell=%d \n " , mob_reconf . mob_ctrl_info . target_pci ) ;
int cell_idx = find_cell_idx ( phy - > get_current_earfcn ( ) , mob_reconf . mob_ctrl_info . target_pci ) ;
if ( < 0 ) {
rrc_log - > error ( " Could not find target cell pci=%d\n " , mob_reconf . mob_ctrl_info . target_pci ) ;
int target_cell_idx = find_neighbour_cell ( serving_cell - > earfcn , mob_reconf . mob_ctrl_info . target_pci ) ;
if ( target_ cell_idx < 0 ) {
rrc_log - > error ( " Could not find target cell earfcn=%d, pci=%d\n " , serving_cell - > earfcn , mob_reconf . mob_ctrl_info . target_pci ) ;
return false ;
}
@ -1007,16 +1064,12 @@ bool rrc::ho_prepare() {
mac_timers - > timer_get ( t310 ) - > stop ( ) ;
mac_timers - > timer_get ( t304 ) - > set ( this , liblte_rrc_t304_num [ mob_reconf . mob_ctrl_info . t304 ] ) ;
if ( mob_reconf . mob_ctrl_info . carrier_freq_eutra_present & &
mob_reconf . mob_ctrl_info . carrier_freq_eutra . dl_carrier_freq ! = current _cell- > earfcn ) {
mob_reconf . mob_ctrl_info . carrier_freq_eutra . dl_carrier_freq ! = serving _cell- > earfcn ) {
rrc_log - > warning ( " Received mobilityControlInfo for inter-frequency handover \n " ) ;
}
// Save cell and current configuration
ho_src_cell_idx = find_cell_idx ( phy - > get_current_earfcn ( ) , phy - > get_current_pci ( ) ) ;
if ( ho_src_cell_idx < 0 ) {
rrc_log - > error ( " Source cell not found in known cells. Reconnecting to cell 0 in case of failure \n " ) ;
ho_src_cell_idx = 0 ;
}
// Save serving cell and current configuration
ho_src_cell = * serving_cell ;
phy - > get_config ( & ho_src_phy_cfg ) ;
mac - > get_config ( & ho_src_mac_cfg ) ;
mac_interface_rrc : : ue_rnti_t uernti ;
@ -1033,9 +1086,9 @@ bool rrc::ho_prepare() {
mac - > set_ho_rnti ( mob_reconf . mob_ctrl_info . new_ue_id , mob_reconf . mob_ctrl_info . target_pci ) ;
apply_rr_config_common_dl ( & mob_reconf . mob_ctrl_info . rr_cnfg_common ) ;
rrc_log - > info ( " Selecting new cell pci=%d \n " , known_cells[ cell_idx ] . phy_cell . id ) ;
if ( ! phy - > cell_handover ( known_cells[ cell_idx ] . phy_cell ) ) {
rrc_log - > error ( " Could not synchronize with target cell pci=%d \n " , known_cells[ cell_idx ] . phy_cell . id ) ;
rrc_log - > info ( " Selecting new cell pci=%d \n " , neighbour_cells[ target_cell_idx ] - > phy_cell . id ) ;
if ( ! phy - > cell_handover ( neighbour_cells[ target_cell_idx ] - > phy_cell ) ) {
rrc_log - > error ( " Could not synchronize with target cell pci=%d \n " , neighbour_cells[ target_cell_idx ] - > phy_cell . id ) ;
return false ;
}
@ -1110,8 +1163,8 @@ void rrc::ho_ra_completed(bool ra_successful) {
void rrc : : ho_failed ( ) {
// Instruct PHY to resync with source PCI
if ( ! phy - > cell_handover ( known_cells[ ho_src_cell_idx] . phy_cell ) ) {
rrc_log - > error ( " Could not synchronize with target cell pci=%d \n " , known_cells[ ho_src_cell_idx] . phy_cell . id ) ;
if ( ! phy - > cell_handover ( . phy_cell ) ) {
rrc_log - > error ( " Could not synchronize with target cell pci=%d \n " , . phy_cell . id ) ;
return ;
}
@ -1172,7 +1225,30 @@ void rrc::rrc_connection_release() {
rrc_log - > console ( " Received RRC Connection Release \n " ) ;
}
/* Actions upon leaving RRC_CONNECTED 5.3.12 */
void rrc : : leave_connected ( )
{
rrc_log - > console ( " RRC IDLE \n " ) ;
rrc_log - > info ( " Leaving RRC_CONNECTED state \n " ) ;
drb_up = false ;
measurements . reset ( ) ;
pdcp - > reset ( ) ;
rlc - > reset ( ) ;
phy - > reset ( ) ;
mac - > reset ( ) ;
set_phy_default ( ) ;
set_mac_default ( ) ;
mac_timers - > timer_get ( t301 ) - > stop ( ) ;
mac_timers - > timer_get ( t310 ) - > stop ( ) ;
mac_timers - > timer_get ( t311 ) - > stop ( ) ;
mac_timers - > timer_get ( t304 ) - > stop ( ) ;
if ( phy - > sync_status ( ) ) {
// Instruct MAC to look for P-RNTI
mac - > pcch_start_rx ( ) ;
// Instruct PHY to measure serving cell for cell reselection
phy - > meas_start ( phy - > get_current_earfcn ( ) , phy - > get_current_pci ( ) ) ;
}
}
@ -1213,24 +1289,24 @@ void rrc::write_pdu_bcch_dlsch(byte_buffer_t *pdu) {
rrc_log - > info ( " Processing SIB: %d \n " , liblte_rrc_sys_info_block_type_num [ dlsch_msg . sibs [ i ] . sib_type ] ) ;
if ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_1 = = dlsch_msg . sibs [ i ] . sib_type & & SI_ACQUIRE_SIB1 = = si_acquire_state ) {
memcpy ( & current _cell- > sib1 , & dlsch_msg . sibs [ i ] . sib . sib1 , sizeof ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_1_STRUCT ) ) ;
current _cell- > has_valid_sib1 = true ;
memcpy ( & serving _cell- > sib1 , & dlsch_msg . sibs [ i ] . sib . sib1 , sizeof ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_1_STRUCT ) ) ;
serving _cell- > has_valid_sib1 = true ;
handle_sib1 ( ) ;
} else if ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_2 = = dlsch_msg . sibs [ i ] . sib_type & & ! current _cell- > has_valid_sib2 ) {
memcpy ( & current _cell- > sib2 , & dlsch_msg . sibs [ i ] . sib . sib2 , sizeof ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_2_STRUCT ) ) ;
current _cell- > has_valid_sib2 = true ;
} else if ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_2 = = dlsch_msg . sibs [ i ] . sib_type & & ! serving _cell- > has_valid_sib2 ) {
memcpy ( & serving _cell- > sib2 , & dlsch_msg . sibs [ i ] . sib . sib2 , sizeof ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_2_STRUCT ) ) ;
serving _cell- > has_valid_sib2 = true ;
handle_sib2 ( ) ;
} else if ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_3 = = dlsch_msg . sibs [ i ] . sib_type & & ! current _cell- > has_valid_sib3 ) {
memcpy ( & current _cell- > sib3 , & dlsch_msg . sibs [ i ] . sib . sib3 , sizeof ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_3_STRUCT ) ) ;
current _cell- > has_valid_sib3 = true ;
} else if ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_3 = = dlsch_msg . sibs [ i ] . sib_type & & ! serving _cell- > has_valid_sib3 ) {
memcpy ( & serving _cell- > sib3 , & dlsch_msg . sibs [ i ] . sib . sib3 , sizeof ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_3_STRUCT ) ) ;
serving _cell- > has_valid_sib3 = true ;
handle_sib3 ( ) ;
} else if ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_13 = = dlsch_msg . sibs [ i ] . sib_type & & ! current _cell- > has_valid_sib13 ) {
memcpy ( & current _cell- > sib13 , & dlsch_msg . sibs [ 0 ] . sib . sib13 , sizeof ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_13_STRUCT ) ) ;
current _cell- > has_valid_sib13 = true ;
} else if ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_13 = = dlsch_msg . sibs [ i ] . sib_type & & ! serving _cell- > has_valid_sib13 ) {
memcpy ( & serving _cell- > sib13 , & dlsch_msg . sibs [ 0 ] . sib . sib13 , sizeof ( LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_13_STRUCT ) ) ;
serving _cell- > has_valid_sib13 = true ;
handle_sib13 ( ) ;
}
}
if ( current _cell- > has_valid_sib2 ) {
if ( serving _cell- > has_valid_sib2 ) {
sysinfo_index + + ;
}
}
@ -1238,16 +1314,16 @@ void rrc::write_pdu_bcch_dlsch(byte_buffer_t *pdu) {
void rrc : : handle_sib1 ( )
{
rrc_log - > info ( " SIB1 received, CellID=%d, si_window=%d, sib2_period=%d \n " ,
current _cell- > sib1 . cell_id & 0xfff ,
liblte_rrc_si_window_length_num [ current _cell- > sib1 . si_window_length ] ,
liblte_rrc_si_periodicity_num [ current _cell- > sib1 . sched_info [ 0 ] . si_periodicity ] ) ;
serving _cell- > sib1 . cell_id & 0xfff ,
liblte_rrc_si_window_length_num [ serving _cell- > sib1 . si_window_length ] ,
liblte_rrc_si_periodicity_num [ serving _cell- > sib1 . sched_info [ 0 ] . si_periodicity ] ) ;
// Print SIB scheduling info
uint32_t i , j ;
for ( i = 0 ; i < current _cell- > sib1 . N_sched_info ; i + + ) {
for ( j = 0 ; j < current _cell- > sib1 . sched_info [ i ] . N_sib_mapping_info ; j + + ) {
LIBLTE_RRC_SIB_TYPE_ENUM t = current _cell- > sib1 . sched_info [ i ] . sib_mapping_info [ j ] . sib_type ;
LIBLTE_RRC_SI_PERIODICITY_ENUM p = current _cell- > sib1 . sched_info [ i ] . si_periodicity ;
for ( i = 0 ; i < serving _cell- > sib1 . N_sched_info ; i + + ) {
for ( j = 0 ; j < serving _cell- > sib1 . sched_info [ i ] . N_sib_mapping_info ; j + + ) {
LIBLTE_RRC_SIB_TYPE_ENUM t = serving _cell- > sib1 . sched_info [ i ] . sib_mapping_info [ j ] . sib_type ;
LIBLTE_RRC_SI_PERIODICITY_ENUM p = serving _cell- > sib1 . sched_info [ i ] . si_periodicity ;
rrc_log - > debug ( " SIB scheduling info, sib_type=%d, si_periodicity=%d \n " ,
liblte_rrc_sib_type_num [ t ] ,
liblte_rrc_si_periodicity_num [ p ] ) ;
@ -1255,16 +1331,16 @@ void rrc::handle_sib1()
}
// Set TDD Config
if ( current _cell- > sib1 . tdd ) {
phy - > set_config_tdd ( & current _cell- > sib1 . tdd_cnfg ) ;
if ( serving _cell- > sib1 . tdd ) {
phy - > set_config_tdd ( & serving _cell- > sib1 . tdd_cnfg ) ;
}
current _cell- > has_valid_sib1 = true ;
serving _cell- > has_valid_sib1 = true ;
// Send PLMN and TAC to NAS
std : : stringstream ss ;
for ( uint32_t i = 0 ; i < current _cell- > sib1 . N_plmn_ids ; i + + ) {
nas - > plmn_found ( current _cell- > sib1 . plmn_id [ i ] . id , current _cell- > sib1 . tracking_area_code ) ;
for ( uint32_t i = 0 ; i < serving _cell- > sib1 . N_plmn_ids ; i + + ) {
nas - > plmn_found ( serving _cell- > sib1 . plmn_id [ i ] . id , serving _cell- > sib1 . tracking_area_code ) ;
}
// Jump to next state
@ -1287,7 +1363,7 @@ void rrc::handle_sib2()
{
rrc_log - > info ( " SIB2 received \n " ) ;
apply_sib2_configs ( & current _cell- > sib2 ) ;
apply_sib2_configs ( & serving _cell- > sib2 ) ;
}
@ -1295,7 +1371,7 @@ void rrc::handle_sib3()
{
rrc_log - > info ( " SIB3 received \n " ) ;
LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_3_STRUCT * sib3 = & current _cell- > sib3 ;
LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_3_STRUCT * sib3 = & serving _cell- > sib3 ;
// cellReselectionInfoCommon
cell_resel_cfg . q_hyst = liblte_rrc_q_hyst_num [ sib3 - > q_hyst ] ;
@ -1317,9 +1393,9 @@ void rrc::handle_sib13()
{
rrc_log - > info ( " SIB13 received \n " ) ;
// mac->set_config_mbsfn_sib13(& current _cell->sib13.mbsfn_area_info_list_r9[0],
// current _cell->sib13.mbsfn_area_info_list_r9_size,
// & current _cell->sib13.mbsfn_notification_config);
// mac->set_config_mbsfn_sib13(& serving _cell->sib13.mbsfn_area_info_list_r9[0],
// serving _cell->sib13.mbsfn_area_info_list_r9_size,
// & serving _cell->sib13.mbsfn_notification_config);
}
@ -1499,7 +1575,7 @@ void rrc::parse_dl_ccch(byte_buffer_t *pdu) {
case LIBLTE_RRC_DL_CCCH_MSG_TYPE_RRC_CON_REJ :
rrc_log - > info ( " Connection Reject received. Wait time: %d \n " ,
dl_ccch_msg . msg . rrc_con_rej . wait_time ) ;
state = RRC_STATE_ ID LE;
state = RRC_STATE_ LEAVE_CONNECTED ;
break ;
case LIBLTE_RRC_DL_CCCH_MSG_TYPE_RRC_CON_SETUP :
rrc_log - > info ( " Connection Setup received \n " ) ;
@ -1607,7 +1683,7 @@ void rrc::parse_dl_dcch(uint32_t lcid, byte_buffer_t *pdu) {
*
* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
void rrc : : enable_capabilities ( ) {
bool enable_ul_64 = args . ue_category > = 5 & & current _cell- > sib2 . rr_config_common_sib . pusch_cnfg . enable_64_qam ;
bool enable_ul_64 = args . ue_category > = 5 & & serving _cell- > sib2 . rr_config_common_sib . pusch_cnfg . enable_64_qam ;
rrc_log - > info ( " %s 64QAM PUSCH \n " , enable_ul_64 ? " Enabling " : " Disabling " ) ;
phy - > set_config_64qam_en ( enable_ul_64 ) ;
}
@ -2272,14 +2348,20 @@ void rrc::rrc_meas::L3_filter(meas_value_t *value, float values[NOF_MEASUREMENTS
void rrc : : rrc_meas : : new_phy_meas ( uint32_t earfcn , uint32_t pci , float rsrp , float rsrq , uint32_t tti )
{
float values [ NOF_MEASUREMENTS ] = { rsrp , rsrq } ;
// This indicates serving cell
if ( earfcn = = 0 ) {
if ( parent- > serving_cell - > equals ( earfcn , pci ) ) {
log_h - > info ( " MEAS: New measurement serving cell, rsrp=%f, rsrq=%f, tti=%d \n " , rsrp , rsrq , tti ) ;
L3_filter ( & pcell_measurement , values ) ;
// Update serving cell measurement
parent - > serving_cell - > rsrp = rsrp ;
} else {
// Add to known cells
// Add to list of neighbour cells
parent - > add_neighbour_cell ( earfcn , pci , rsrp ) ;
log_h - > info ( " MEAS: New measurement earfcn=%d, pci=%d, rsrp=%f, rsrq=%f, tti=%d \n " , earfcn , pci , rsrp , rsrq , tti ) ;
@ -2299,8 +2381,6 @@ void rrc::rrc_meas::new_phy_meas(uint32_t earfcn, uint32_t pci, float rsrp, floa
return ;
}
}
parent - > rrc_log - > warning ( " MEAS: Received measurement from unknown EARFCN=%d \n " , earfcn ) ;
}
}
Ismael Gomez
7 years ago