import gsm48_decode_lai() function from osmocom-bb/mobile sysinfo.c

1 files changed, 14 insertions, 0 deletions

diff --git a/src/gsm/gsm48.c b/src/gsm/gsm48.c
index 379ed65c..61e5d2cb 100644
--- a/src/gsm/gsm48.c
+++ b/src/gsm/gsm48.c
@@ -285,6 +285,20 @@ void gsm48_generate_lai(struct gsm48_loc_area_id *lai48, uint16_t mcc,
 	lai48->lac = htons(lac);
 }
 
+int gsm48_decode_lai(struct gsm48_loc_area_id *lai, uint16_t *mcc,
+		     uint16_t *mnc, uint16_t *lac)
+{
+	*mcc = ((lai->digits[0] & 0x0f) << 8)
+	     | (lai->digits[0] & 0xf0)
+	     | (lai->digits[1] & 0x0f);
+	*mnc = ((lai->digits[2] & 0x0f) << 8)
+	     | (lai->digits[2] & 0xf0)
+	     | ((lai->digits[1] & 0xf0) >> 4);
+	*lac = ntohs(lai->lac);
+
+	return 0;
+}
+
 int gsm48_generate_mid_from_tmsi(uint8_t *buf, uint32_t tmsi)
 {
 	uint32_t *tptr = (uint32_t *) &buf[3];