diff options
| author | Yang Gu <yang.gu@intel.com> | 2010-03-05 12:34:28 +0800 |
|---|---|---|
| committer | Denis Kenzior <denkenz@gmail.com> | 2010-03-10 13:14:11 -0600 |
| commit | ec31f1eabbe30bb6c90827b7c96ae1c27d71e1c2 (patch) | |
| tree | 9991413eb833adda0bde8dd7018977b698e8eb2a /src/stkutil.c | |
| parent | 00262e36dbf5fff2c780afe19cbc3154926bba26 (diff) | |
| download | ofono-ec31f1eabbe30bb6c90827b7c96ae1c27d71e1c2.tar.bz2 | |
Add parser for address objects
Diffstat (limited to 'src/stkutil.c')
| -rw-r--r-- | src/stkutil.c | 28 |
1 files changed, 28 insertions, 0 deletions
diff --git a/src/stkutil.c b/src/stkutil.c index 6a95cd23..e98ad589 100644 --- a/src/stkutil.c +++ b/src/stkutil.c @@ -41,6 +41,32 @@ enum stk_data_object_flag { typedef gboolean (*dataobj_handler)(struct comprehension_tlv_iter *, void *); +/* Defined in TS 102.223 Section 8.1 */ +static gboolean parse_dataobj_address(struct comprehension_tlv_iter *iter, + void *user) +{ + struct stk_address *addr = user; + const unsigned char *data; + unsigned int len; + + if (comprehension_tlv_iter_get_tag(iter) != + STK_DATA_OBJECT_TYPE_ADDRESS) + return FALSE; + + len = comprehension_tlv_iter_get_length(iter); + if (len < 2) + return FALSE; + + data = comprehension_tlv_iter_get_data(iter); + + addr->ton = (data[0] >> 4) & 0x07; + addr->npi = data[0] & 0x0f; + addr->number = g_malloc(len*2-1); + extract_bcd_number(data+1, len-1, addr->number); + + return TRUE; +} + /* Described in TS 102.223 Section 8.8 */ static gboolean parse_dataobj_duration(struct comprehension_tlv_iter *iter, void *user) @@ -253,6 +279,8 @@ static gboolean parse_dataobj_frame_id(struct comprehension_tlv_iter *iter, static dataobj_handler handler_for_type(enum stk_data_object_type type) { switch (type) { + case STK_DATA_OBJECT_TYPE_ADDRESS: + return parse_dataobj_address; case STK_DATA_OBJECT_TYPE_DURATION: return parse_dataobj_duration; case STK_DATA_OBJECT_TYPE_RESPONSE_LENGTH: |