uqmi: print radio interfaces in serving system command

[project/uqmi.git] / data / gen-code.pl

diff --git a/data/gen-code.pl b/data/gen-code.pl
index 63871a01eb7da50625da50c2c5c0e3f3c598a6f9..d05cc766bb6eb75c8a615dfdf31b7e4bd26d6d1b 100755 (executable)
--- a/data/gen-code.pl
+++ b/data/gen-code.pl
@@ -19,6 +19,7 @@ my %tlv_get = (
        guint32 => "le32_to_cpu(*(uint32_t *) get_next(4))",
        gint64 => "le64_to_cpu(*(uint64_t *) get_next(8))",
        guint64 => "le64_to_cpu(*(uint64_t *) get_next(8))",
+       gfloat => "({ uint32_t data = le32_to_cpu(*(uint32_t *) get_next(4)); float _val; memcpy(&_val, &data, sizeof(_val)); _val; })"
 );
 
 my %tlv_get_be = (
@@ -74,10 +75,15 @@ sub gen_tlv_parse_field($$$$) {
                        $size = $tlv_get{$prefix};
                        die "Unknown size element type '$prefix'" if not defined $size;
 
+                       my $curvar = "$var\_n";
+                       if (rindex($var,"]") == length($var)-1) {
+                               $curvar = substr($var, 0, index($var, "["))."\_i";
+                               $data .= $indent."$curvar = 0;\n";
+                       }
                        ($var_data, $var_iterator) =
-                               gen_tlv_parse_field($var."[$var\_n]", $elem->{"array-element"}, $n_indent + 1, "i$iterator");
+                               gen_tlv_parse_field($var."[$curvar]", $elem->{"array-element"}, $n_indent + 1, "i$iterator");
 
-                       $var_data .= $indent."\t$var\_n++;\n";
+                       $var_data .= $indent."\t$curvar++;\n";
                        $data .= $indent."$iterator = $size;\n";
                        $data .= $indent."$var = __qmi_alloc_static($iterator * sizeof($var\[0]));\n";
                        $data .= $indent."while($iterator\-- > 0) {\n";
@@ -214,6 +220,73 @@ EOF
                switch(tlv->type) {
 EOF
                foreach my $field (@$data) {
+                       $field = gen_common_ref($field);
+                       my $cname = gen_cname($field->{name});
+                       gen_tlv_type($cname, $field, $i++);
+               }
+
+               print <<EOF;
+               default:
+                       break;
+               }
+       }
+
+       return 0;
+
+error_len:
+       fprintf(stderr, "%s: Invalid TLV length in message, tlv=0x%02x, len=%d\\n",
+               __func__, tlv->type, le16_to_cpu(tlv->len));
+       return QMI_ERROR_INVALID_DATA;
+EOF
+       } else {
+               print <<EOF;
+
+       return qmi_check_message_status(tlv_buf, tlv_len);
+EOF
+       }
+
+       print <<EOF;
+}
+
+EOF
+}
+
+sub gen_parse_ind_func($$)
+{
+       my $name = shift;
+       my $data = shift;
+
+       my $type = "svc";
+       $ctl and $type = "ctl";
+
+       print gen_tlv_parse_func($name, $data)."\n";
+       print <<EOF;
+{
+       void *tlv_buf = &msg->$type.tlv;
+       unsigned int tlv_len = le16_to_cpu(msg->$type.tlv_len);
+EOF
+
+       if (gen_has_types($data)) {
+               my $n_bits = scalar @$data;
+               my $n_words = int(($n_bits + 31) / 32);
+               my $i = 0;
+
+               print <<EOF;
+       struct tlv *tlv;
+       int i;
+       uint32_t found[$n_words] = {};
+
+       memset(res, 0, sizeof(*res));
+
+       __qmi_alloc_reset();
+       while ((tlv = tlv_get_next(&tlv_buf, &tlv_len)) != NULL) {
+               unsigned int cur_tlv_len = le16_to_cpu(tlv->len);
+               unsigned int ofs = 0;
+
+               switch(tlv->type) {
+EOF
+               foreach my $field (@$data) {
+                       $field = gen_common_ref($field);
                        my $cname = gen_cname($field->{name});
                        gen_tlv_type($cname, $field, $i++);
                }
@@ -413,6 +486,7 @@ sub gen_set_func($$)
 
 EOF
        foreach my $field (@$fields) {
+               $field = gen_common_ref($field);
                my $cname = gen_cname($field->{name});
                gen_tlv_attr_set($cname, $field);
        }
@@ -446,4 +520,4 @@ print <<EOF;
 
 EOF
 
-gen_foreach_message_type($data, \&gen_set_func, \&gen_parse_func);
+gen_foreach_message_type($data, \&gen_set_func, \&gen_parse_func, \&gen_parse_ind_func);