1 // SPDX-License-Identifier: GPL-2.0 OR MIT 2 3 /* 4 * Xen para-virtual sound device 5 * 6 * Copyright (C) 2016-2018 EPAM Systems Inc. 7 * 8 * Author: Oleksandr Andrushchenko <oleksandr_andrushchenko@epam.com> 9 */ 10 11 #include <xen/xenbus.h> 12 13 #include <xen/interface/io/sndif.h> 14 15 #include "xen_snd_front.h" 16 #include "xen_snd_front_cfg.h" 17 18 /* Maximum number of supported streams. */ 19 #define VSND_MAX_STREAM 8 20 21 struct cfg_hw_sample_rate { 22 const char *name; 23 unsigned int mask; 24 unsigned int value; 25 }; 26 27 static const struct cfg_hw_sample_rate CFG_HW_SUPPORTED_RATES[] = { 28 { .name = "5512", .mask = SNDRV_PCM_RATE_5512, .value = 5512 }, 29 { .name = "8000", .mask = SNDRV_PCM_RATE_8000, .value = 8000 }, 30 { .name = "11025", .mask = SNDRV_PCM_RATE_11025, .value = 11025 }, 31 { .name = "16000", .mask = SNDRV_PCM_RATE_16000, .value = 16000 }, 32 { .name = "22050", .mask = SNDRV_PCM_RATE_22050, .value = 22050 }, 33 { .name = "32000", .mask = SNDRV_PCM_RATE_32000, .value = 32000 }, 34 { .name = "44100", .mask = SNDRV_PCM_RATE_44100, .value = 44100 }, 35 { .name = "48000", .mask = SNDRV_PCM_RATE_48000, .value = 48000 }, 36 { .name = "64000", .mask = SNDRV_PCM_RATE_64000, .value = 64000 }, 37 { .name = "96000", .mask = SNDRV_PCM_RATE_96000, .value = 96000 }, 38 { .name = "176400", .mask = SNDRV_PCM_RATE_176400, .value = 176400 }, 39 { .name = "192000", .mask = SNDRV_PCM_RATE_192000, .value = 192000 }, 40 }; 41 42 struct cfg_hw_sample_format { 43 const char *name; 44 u64 mask; 45 }; 46 47 static const struct cfg_hw_sample_format CFG_HW_SUPPORTED_FORMATS[] = { 48 { 49 .name = XENSND_PCM_FORMAT_U8_STR, 50 .mask = SNDRV_PCM_FMTBIT_U8 51 }, 52 { 53 .name = XENSND_PCM_FORMAT_S8_STR, 54 .mask = SNDRV_PCM_FMTBIT_S8 55 }, 56 { 57 .name = XENSND_PCM_FORMAT_U16_LE_STR, 58 .mask = SNDRV_PCM_FMTBIT_U16_LE 59 }, 60 { 61 .name = XENSND_PCM_FORMAT_U16_BE_STR, 62 .mask = SNDRV_PCM_FMTBIT_U16_BE 63 }, 64 { 65 .name = XENSND_PCM_FORMAT_S16_LE_STR, 66 .mask = SNDRV_PCM_FMTBIT_S16_LE 67 }, 68 { 69 .name = XENSND_PCM_FORMAT_S16_BE_STR, 70 .mask = SNDRV_PCM_FMTBIT_S16_BE 71 }, 72 { 73 .name = XENSND_PCM_FORMAT_U24_LE_STR, 74 .mask = SNDRV_PCM_FMTBIT_U24_LE 75 }, 76 { 77 .name = XENSND_PCM_FORMAT_U24_BE_STR, 78 .mask = SNDRV_PCM_FMTBIT_U24_BE 79 }, 80 { 81 .name = XENSND_PCM_FORMAT_S24_LE_STR, 82 .mask = SNDRV_PCM_FMTBIT_S24_LE 83 }, 84 { 85 .name = XENSND_PCM_FORMAT_S24_BE_STR, 86 .mask = SNDRV_PCM_FMTBIT_S24_BE 87 }, 88 { 89 .name = XENSND_PCM_FORMAT_U32_LE_STR, 90 .mask = SNDRV_PCM_FMTBIT_U32_LE 91 }, 92 { 93 .name = XENSND_PCM_FORMAT_U32_BE_STR, 94 .mask = SNDRV_PCM_FMTBIT_U32_BE 95 }, 96 { 97 .name = XENSND_PCM_FORMAT_S32_LE_STR, 98 .mask = SNDRV_PCM_FMTBIT_S32_LE 99 }, 100 { 101 .name = XENSND_PCM_FORMAT_S32_BE_STR, 102 .mask = SNDRV_PCM_FMTBIT_S32_BE 103 }, 104 { 105 .name = XENSND_PCM_FORMAT_A_LAW_STR, 106 .mask = SNDRV_PCM_FMTBIT_A_LAW 107 }, 108 { 109 .name = XENSND_PCM_FORMAT_MU_LAW_STR, 110 .mask = SNDRV_PCM_FMTBIT_MU_LAW 111 }, 112 { 113 .name = XENSND_PCM_FORMAT_F32_LE_STR, 114 .mask = SNDRV_PCM_FMTBIT_FLOAT_LE 115 }, 116 { 117 .name = XENSND_PCM_FORMAT_F32_BE_STR, 118 .mask = SNDRV_PCM_FMTBIT_FLOAT_BE 119 }, 120 { 121 .name = XENSND_PCM_FORMAT_F64_LE_STR, 122 .mask = SNDRV_PCM_FMTBIT_FLOAT64_LE 123 }, 124 { 125 .name = XENSND_PCM_FORMAT_F64_BE_STR, 126 .mask = SNDRV_PCM_FMTBIT_FLOAT64_BE 127 }, 128 { 129 .name = XENSND_PCM_FORMAT_IEC958_SUBFRAME_LE_STR, 130 .mask = SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE 131 }, 132 { 133 .name = XENSND_PCM_FORMAT_IEC958_SUBFRAME_BE_STR, 134 .mask = SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE 135 }, 136 { 137 .name = XENSND_PCM_FORMAT_IMA_ADPCM_STR, 138 .mask = SNDRV_PCM_FMTBIT_IMA_ADPCM 139 }, 140 { 141 .name = XENSND_PCM_FORMAT_MPEG_STR, 142 .mask = SNDRV_PCM_FMTBIT_MPEG 143 }, 144 { 145 .name = XENSND_PCM_FORMAT_GSM_STR, 146 .mask = SNDRV_PCM_FMTBIT_GSM 147 }, 148 }; 149 150 static void cfg_hw_rates(char *list, unsigned int len, 151 const char *path, struct snd_pcm_hardware *pcm_hw) 152 { 153 char *cur_rate; 154 unsigned int cur_mask; 155 unsigned int cur_value; 156 unsigned int rates; 157 unsigned int rate_min; 158 unsigned int rate_max; 159 int i; 160 161 rates = 0; 162 rate_min = -1; 163 rate_max = 0; 164 while ((cur_rate = strsep(&list, XENSND_LIST_SEPARATOR))) { 165 for (i = 0; i < ARRAY_SIZE(CFG_HW_SUPPORTED_RATES); i++) 166 if (!strncasecmp(cur_rate, 167 CFG_HW_SUPPORTED_RATES[i].name, 168 XENSND_SAMPLE_RATE_MAX_LEN)) { 169 cur_mask = CFG_HW_SUPPORTED_RATES[i].mask; 170 cur_value = CFG_HW_SUPPORTED_RATES[i].value; 171 rates |= cur_mask; 172 if (rate_min > cur_value) 173 rate_min = cur_value; 174 if (rate_max < cur_value) 175 rate_max = cur_value; 176 } 177 } 178 179 if (rates) { 180 pcm_hw->rates = rates; 181 pcm_hw->rate_min = rate_min; 182 pcm_hw->rate_max = rate_max; 183 } 184 } 185 186 static void cfg_formats(char *list, unsigned int len, 187 const char *path, struct snd_pcm_hardware *pcm_hw) 188 { 189 u64 formats; 190 char *cur_format; 191 int i; 192 193 formats = 0; 194 while ((cur_format = strsep(&list, XENSND_LIST_SEPARATOR))) { 195 for (i = 0; i < ARRAY_SIZE(CFG_HW_SUPPORTED_FORMATS); i++) 196 if (!strncasecmp(cur_format, 197 CFG_HW_SUPPORTED_FORMATS[i].name, 198 XENSND_SAMPLE_FORMAT_MAX_LEN)) 199 formats |= CFG_HW_SUPPORTED_FORMATS[i].mask; 200 } 201 202 if (formats) 203 pcm_hw->formats = formats; 204 } 205 206 #define MAX_BUFFER_SIZE (64 * 1024) 207 #define MIN_PERIOD_SIZE 64 208 #define MAX_PERIOD_SIZE MAX_BUFFER_SIZE 209 #define USE_FORMATS (SNDRV_PCM_FMTBIT_U8 | \ 210 SNDRV_PCM_FMTBIT_S16_LE) 211 #define USE_RATE (SNDRV_PCM_RATE_CONTINUOUS | \ 212 SNDRV_PCM_RATE_8000_48000) 213 #define USE_RATE_MIN 5512 214 #define USE_RATE_MAX 48000 215 #define USE_CHANNELS_MIN 1 216 #define USE_CHANNELS_MAX 2 217 #define USE_PERIODS_MIN 2 218 #define USE_PERIODS_MAX (MAX_BUFFER_SIZE / MIN_PERIOD_SIZE) 219 220 static const struct snd_pcm_hardware SND_DRV_PCM_HW_DEFAULT = { 221 .info = (SNDRV_PCM_INFO_MMAP | 222 SNDRV_PCM_INFO_INTERLEAVED | 223 SNDRV_PCM_INFO_RESUME | 224 SNDRV_PCM_INFO_MMAP_VALID), 225 .formats = USE_FORMATS, 226 .rates = USE_RATE, 227 .rate_min = USE_RATE_MIN, 228 .rate_max = USE_RATE_MAX, 229 .channels_min = USE_CHANNELS_MIN, 230 .channels_max = USE_CHANNELS_MAX, 231 .buffer_bytes_max = MAX_BUFFER_SIZE, 232 .period_bytes_min = MIN_PERIOD_SIZE, 233 .period_bytes_max = MAX_PERIOD_SIZE, 234 .periods_min = USE_PERIODS_MIN, 235 .periods_max = USE_PERIODS_MAX, 236 .fifo_size = 0, 237 }; 238 239 static void cfg_read_pcm_hw(const char *path, 240 struct snd_pcm_hardware *parent_pcm_hw, 241 struct snd_pcm_hardware *pcm_hw) 242 { 243 char *list; 244 int val; 245 size_t buf_sz; 246 unsigned int len; 247 248 /* Inherit parent's PCM HW and read overrides from XenStore. */ 249 if (parent_pcm_hw) 250 *pcm_hw = *parent_pcm_hw; 251 else 252 *pcm_hw = SND_DRV_PCM_HW_DEFAULT; 253 254 val = xenbus_read_unsigned(path, XENSND_FIELD_CHANNELS_MIN, 0); 255 if (val) 256 pcm_hw->channels_min = val; 257 258 val = xenbus_read_unsigned(path, XENSND_FIELD_CHANNELS_MAX, 0); 259 if (val) 260 pcm_hw->channels_max = val; 261 262 list = xenbus_read(XBT_NIL, path, XENSND_FIELD_SAMPLE_RATES, &len); 263 if (!IS_ERR(list)) { 264 cfg_hw_rates(list, len, path, pcm_hw); 265 kfree(list); 266 } 267 268 list = xenbus_read(XBT_NIL, path, XENSND_FIELD_SAMPLE_FORMATS, &len); 269 if (!IS_ERR(list)) { 270 cfg_formats(list, len, path, pcm_hw); 271 kfree(list); 272 } 273 274 buf_sz = xenbus_read_unsigned(path, XENSND_FIELD_BUFFER_SIZE, 0); 275 if (buf_sz) 276 pcm_hw->buffer_bytes_max = buf_sz; 277 278 /* Update configuration to match new values. */ 279 if (pcm_hw->channels_min > pcm_hw->channels_max) 280 pcm_hw->channels_min = pcm_hw->channels_max; 281 282 if (pcm_hw->rate_min > pcm_hw->rate_max) 283 pcm_hw->rate_min = pcm_hw->rate_max; 284 285 pcm_hw->period_bytes_max = pcm_hw->buffer_bytes_max; 286 287 pcm_hw->periods_max = pcm_hw->period_bytes_max / 288 pcm_hw->period_bytes_min; 289 } 290 291 static int cfg_get_stream_type(const char *path, int index, 292 int *num_pb, int *num_cap) 293 { 294 char *str = NULL; 295 char *stream_path; 296 int ret; 297 298 *num_pb = 0; 299 *num_cap = 0; 300 stream_path = kasprintf(GFP_KERNEL, "%s/%d", path, index); 301 if (!stream_path) { 302 ret = -ENOMEM; 303 goto fail; 304 } 305 306 str = xenbus_read(XBT_NIL, stream_path, XENSND_FIELD_TYPE, NULL); 307 if (IS_ERR(str)) { 308 ret = PTR_ERR(str); 309 str = NULL; 310 goto fail; 311 } 312 313 if (!strncasecmp(str, XENSND_STREAM_TYPE_PLAYBACK, 314 sizeof(XENSND_STREAM_TYPE_PLAYBACK))) { 315 (*num_pb)++; 316 } else if (!strncasecmp(str, XENSND_STREAM_TYPE_CAPTURE, 317 sizeof(XENSND_STREAM_TYPE_CAPTURE))) { 318 (*num_cap)++; 319 } else { 320 ret = -EINVAL; 321 goto fail; 322 } 323 ret = 0; 324 325 fail: 326 kfree(stream_path); 327 kfree(str); 328 return ret; 329 } 330 331 static int cfg_stream(struct xen_snd_front_info *front_info, 332 struct xen_front_cfg_pcm_instance *pcm_instance, 333 const char *path, int index, int *cur_pb, int *cur_cap, 334 int *stream_cnt) 335 { 336 char *str = NULL; 337 char *stream_path; 338 struct xen_front_cfg_stream *stream; 339 int ret; 340 341 stream_path = devm_kasprintf(&front_info->xb_dev->dev, 342 GFP_KERNEL, "%s/%d", path, index); 343 if (!stream_path) { 344 ret = -ENOMEM; 345 goto fail; 346 } 347 348 str = xenbus_read(XBT_NIL, stream_path, XENSND_FIELD_TYPE, NULL); 349 if (IS_ERR(str)) { 350 ret = PTR_ERR(str); 351 str = NULL; 352 goto fail; 353 } 354 355 if (!strncasecmp(str, XENSND_STREAM_TYPE_PLAYBACK, 356 sizeof(XENSND_STREAM_TYPE_PLAYBACK))) { 357 stream = &pcm_instance->streams_pb[(*cur_pb)++]; 358 } else if (!strncasecmp(str, XENSND_STREAM_TYPE_CAPTURE, 359 sizeof(XENSND_STREAM_TYPE_CAPTURE))) { 360 stream = &pcm_instance->streams_cap[(*cur_cap)++]; 361 } else { 362 ret = -EINVAL; 363 goto fail; 364 } 365 366 /* Get next stream index. */ 367 stream->index = (*stream_cnt)++; 368 stream->xenstore_path = stream_path; 369 /* 370 * Check XenStore if PCM HW configuration exists for this stream 371 * and update if so, e.g. we inherit all values from device's PCM HW, 372 * but can still override some of the values for the stream. 373 */ 374 cfg_read_pcm_hw(stream->xenstore_path, 375 &pcm_instance->pcm_hw, &stream->pcm_hw); 376 ret = 0; 377 378 fail: 379 kfree(str); 380 return ret; 381 } 382 383 static int cfg_device(struct xen_snd_front_info *front_info, 384 struct xen_front_cfg_pcm_instance *pcm_instance, 385 struct snd_pcm_hardware *parent_pcm_hw, 386 const char *path, int node_index, int *stream_cnt) 387 { 388 char *str; 389 char *device_path; 390 int ret, i, num_streams; 391 int num_pb, num_cap; 392 int cur_pb, cur_cap; 393 char node[3]; 394 395 device_path = kasprintf(GFP_KERNEL, "%s/%d", path, node_index); 396 if (!device_path) 397 return -ENOMEM; 398 399 str = xenbus_read(XBT_NIL, device_path, XENSND_FIELD_DEVICE_NAME, NULL); 400 if (!IS_ERR(str)) { 401 strscpy(pcm_instance->name, str, sizeof(pcm_instance->name)); 402 kfree(str); 403 } 404 405 pcm_instance->device_id = node_index; 406 407 /* 408 * Check XenStore if PCM HW configuration exists for this device 409 * and update if so, e.g. we inherit all values from card's PCM HW, 410 * but can still override some of the values for the device. 411 */ 412 cfg_read_pcm_hw(device_path, parent_pcm_hw, &pcm_instance->pcm_hw); 413 414 /* Find out how many streams were configured in Xen store. */ 415 num_streams = 0; 416 do { 417 snprintf(node, sizeof(node), "%d", num_streams); 418 if (!xenbus_exists(XBT_NIL, device_path, node)) 419 break; 420 421 num_streams++; 422 } while (num_streams < VSND_MAX_STREAM); 423 424 pcm_instance->num_streams_pb = 0; 425 pcm_instance->num_streams_cap = 0; 426 /* Get number of playback and capture streams. */ 427 for (i = 0; i < num_streams; i++) { 428 ret = cfg_get_stream_type(device_path, i, &num_pb, &num_cap); 429 if (ret < 0) 430 goto fail; 431 432 pcm_instance->num_streams_pb += num_pb; 433 pcm_instance->num_streams_cap += num_cap; 434 } 435 436 if (pcm_instance->num_streams_pb) { 437 pcm_instance->streams_pb = 438 devm_kcalloc(&front_info->xb_dev->dev, 439 pcm_instance->num_streams_pb, 440 sizeof(struct xen_front_cfg_stream), 441 GFP_KERNEL); 442 if (!pcm_instance->streams_pb) { 443 ret = -ENOMEM; 444 goto fail; 445 } 446 } 447 448 if (pcm_instance->num_streams_cap) { 449 pcm_instance->streams_cap = 450 devm_kcalloc(&front_info->xb_dev->dev, 451 pcm_instance->num_streams_cap, 452 sizeof(struct xen_front_cfg_stream), 453 GFP_KERNEL); 454 if (!pcm_instance->streams_cap) { 455 ret = -ENOMEM; 456 goto fail; 457 } 458 } 459 460 cur_pb = 0; 461 cur_cap = 0; 462 for (i = 0; i < num_streams; i++) { 463 ret = cfg_stream(front_info, pcm_instance, device_path, i, 464 &cur_pb, &cur_cap, stream_cnt); 465 if (ret < 0) 466 goto fail; 467 } 468 ret = 0; 469 470 fail: 471 kfree(device_path); 472 return ret; 473 } 474 475 int xen_snd_front_cfg_card(struct xen_snd_front_info *front_info, 476 int *stream_cnt) 477 { 478 struct xenbus_device *xb_dev = front_info->xb_dev; 479 struct xen_front_cfg_card *cfg = &front_info->cfg; 480 int ret, num_devices, i; 481 char node[3]; 482 483 *stream_cnt = 0; 484 num_devices = 0; 485 do { 486 snprintf(node, sizeof(node), "%d", num_devices); 487 if (!xenbus_exists(XBT_NIL, xb_dev->nodename, node)) 488 break; 489 490 num_devices++; 491 } while (num_devices < SNDRV_PCM_DEVICES); 492 493 if (!num_devices) { 494 dev_warn(&xb_dev->dev, 495 "No devices configured for sound card at %s\n", 496 xb_dev->nodename); 497 return -ENODEV; 498 } 499 500 /* Start from default PCM HW configuration for the card. */ 501 cfg_read_pcm_hw(xb_dev->nodename, NULL, &cfg->pcm_hw); 502 503 cfg->pcm_instances = 504 devm_kcalloc(&front_info->xb_dev->dev, num_devices, 505 sizeof(struct xen_front_cfg_pcm_instance), 506 GFP_KERNEL); 507 if (!cfg->pcm_instances) 508 return -ENOMEM; 509 510 for (i = 0; i < num_devices; i++) { 511 ret = cfg_device(front_info, &cfg->pcm_instances[i], 512 &cfg->pcm_hw, xb_dev->nodename, i, stream_cnt); 513 if (ret < 0) 514 return ret; 515 } 516 cfg->num_pcm_instances = num_devices; 517 return 0; 518 } 519 520