Set response length for VirtIO notification

Author: Cuda-Chen

virtio-snd.c

@@ -307,10 +307,12 @@ static void virtio_snd_update_status(virtio_snd_state_t *vsnd, uint32_t status)
 
 static void virtio_snd_read_jack_info_handler(
     virtio_snd_jack_info_t *info,
-    const virtio_snd_query_info_t *query)
+    const virtio_snd_query_info_t *query,
+    uint32_t *plen)
 {
-    printf("jack info handler count %d\n", query->count);
-    for (uint32_t i = 0; i < query->count; i++) {
+    uint32_t cnt = query->count;
+    printf("jack info handler count %d\n", cnt);
+    for (uint32_t i = 0; i < cnt; i++) {
         info[i].hdr.hda_fn_nid = 0;
         info[i].features = 0;
         info[i].hda_reg_defconf = 0;
@@ -325,14 +327,18 @@ static void virtio_snd_read_jack_info_handler(
         vsnd_props[i].j.connected = 1;
         memset(&vsnd_props[i].j.padding, 0, sizeof(vsnd_props[i].j.padding));
     }
+
+    *plen = cnt * sizeof(*info);
 }
 
 static void virtio_snd_read_pcm_info_handler(
     virtio_snd_pcm_info_t *info,
-    const virtio_snd_query_info_t *query)
+    const virtio_snd_query_info_t *query,
+    uint32_t *plen)
 {
-    printf("snd info handler count %d\n", query->count);
-    for (uint32_t i = 0; i < query->count; i++) {
+    uint32_t cnt = query->count;
+    printf("snd info handler count %d\n", cnt);
+    for (uint32_t i = 0; i < cnt; i++) {
         info[i].hdr.hda_fn_nid = 0;
         info[i].features = 0;
         info[i].formats = (1 << VIRTIO_SND_PCM_FMT_S16);
@@ -351,14 +357,17 @@ static void virtio_snd_read_pcm_info_handler(
         vsnd_props[i].p.channels_max = 1;
         memset(&vsnd_props[i].p.padding, 0, sizeof(vsnd_props[i].p.padding));
     }
+    *plen = cnt * sizeof(*info);
 }
 
 static void virtio_snd_read_chmap_info_handler(
     virtio_snd_chmap_info_t *info,
-    const virtio_snd_query_info_t *query)
+    const virtio_snd_query_info_t *query,
+    uint32_t *plen)
 {
-    printf("chmap info handler count %d\n", query->count);
-    for (uint32_t i = 0; i < query->count; i++) {
+    uint32_t cnt = query->count;
+    printf("chmap info handler count %d\n", cnt);
+    for (uint32_t i = 0; i < cnt; i++) {
         info[i].hdr.hda_fn_nid = 0;
         info[i].direction = VIRTIO_SND_D_OUTPUT;
         info[i].channels = 1;
@@ -369,6 +378,7 @@ static void virtio_snd_read_chmap_info_handler(
         vsnd_props[i].c.channels = 1;
         vsnd_props[i].c.positions[0] = VIRTIO_SND_CHMAP_MONO;
     }
+    *plen = cnt * sizeof(info);
 }
 
 static void virtio_snd_read_pcm_set_params(struct virtq_desc *vq_desc,
@@ -604,13 +614,13 @@ static int virtio_snd_desc_handler(virtio_snd_state_t *vsnd,
     /* Process the data */
     switch (type) {
     case VIRTIO_SND_R_JACK_INFO:
-        virtio_snd_read_jack_info_handler(info, query);
+        virtio_snd_read_jack_info_handler(info, query, plen);
         break;
     case VIRTIO_SND_R_PCM_INFO:
-        virtio_snd_read_pcm_info_handler(info, query);
+        virtio_snd_read_pcm_info_handler(info, query, plen);
         break;
     case VIRTIO_SND_R_CHMAP_INFO:
-        virtio_snd_read_chmap_info_handler(info, query);
+        virtio_snd_read_chmap_info_handler(info, query, plen);
         break;
     case VIRTIO_SND_R_PCM_SET_PARAMS:
         virtio_snd_read_pcm_set_params(vq_desc, query);
@@ -636,7 +646,7 @@ static int virtio_snd_desc_handler(virtio_snd_state_t *vsnd,
 
     /* Return the device status */
     response->code = VIRTIO_SND_S_OK;
-    *plen = vq_desc[2].len;
+    //*plen = vq_desc[2].len;
 
     return 0;
 }