drivers/slimbus/stream.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 // Copyright (c) 2018, Linaro Limited
   3
   4 #include <linux/kernel.h>
   5 #include <linux/errno.h>
   6 #include <linux/slab.h>
   7 #include <linux/list.h>
   8 #include <linux/slimbus.h>
   9 #include <uapi/sound/asound.h>
  10 #include "slimbus.h"
  11
  12 /**
  13  * struct segdist_code - Segment Distributions code from
  14  *      Table 20 of SLIMbus Specs Version 2.0
  15  *
  16  * @ratem: Channel Rate Multipler(Segments per Superframe)
  17  * @seg_interval: Number of slots between the first Slot of Segment
  18  *              and the first slot of the next  consecutive Segment.
  19  * @segdist_code: Segment Distribution Code SD[11:0]
  20  * @seg_offset_mask: Segment offset mask in SD[11:0]
  21  * @segdist_codes: List of all possible Segmet Distribution codes.
  22  */
  23 static const struct segdist_code {
  24         int ratem;
  25         int seg_interval;
  26         int segdist_code;
  27         u32 seg_offset_mask;
  28
  29 } segdist_codes[] = {
  30         {1,     1536,   0x200,   0xdff},
  31         {2,     768,    0x100,   0xcff},
  32         {4,     384,    0x080,   0xc7f},
  33         {8,     192,    0x040,   0xc3f},
  34         {16,    96,     0x020,   0xc1f},
  35         {32,    48,     0x010,   0xc0f},
  36         {64,    24,     0x008,   0xc07},
  37         {128,   12,     0x004,   0xc03},
  38         {256,   6,      0x002,   0xc01},
  39         {512,   3,      0x001,   0xc00},
  40         {3,     512,    0xe00,   0x1ff},
  41         {6,     256,    0xd00,   0x0ff},
  42         {12,    128,    0xc80,   0x07f},
  43         {24,    64,     0xc40,   0x03f},
  44         {48,    32,     0xc20,   0x01f},
  45         {96,    16,     0xc10,   0x00f},
  46         {192,   8,      0xc08,   0x007},
  47         {364,   4,      0xc04,   0x003},
  48         {768,   2,      0xc02,   0x001},
  49 };
  50
  51 /*
  52  * Presence Rate table for all Natural Frequencies
  53  * The Presence rate of a constant bitrate stream is mean flow rate of the
  54  * stream expressed in occupied Segments of that Data Channel per second.
  55  * Table 66 from SLIMbus 2.0 Specs
  56  *
  57  * Index of the table corresponds to Presence rate code for the respective rate
  58  * in the table.
  59  */
  60 static const int slim_presence_rate_table[] = {
  61         0, /* Not Indicated */
  62         12000,
  63         24000,
  64         48000,
  65         96000,
  66         192000,
  67         384000,
  68         768000,
  69         0, /* Reserved */
  70         110250,
  71         220500,
  72         441000,
  73         882000,
  74         176400,
  75         352800,
  76         705600,
  77         4000,
  78         8000,
  79         16000,
  80         32000,
  81         64000,
  82         128000,
  83         256000,
  84         512000,
  85 };
  86
  87 /*
  88  * slim_stream_allocate() - Allocate a new SLIMbus Stream
  89  * @dev:Slim device to be associated with
  90  * @name: name of the stream
  91  *
  92  * This is very first call for SLIMbus streaming, this API will allocate
  93  * a new SLIMbus stream and return a valid stream runtime pointer for client
  94  * to use it in subsequent stream apis. state of stream is set to ALLOCATED
  95  *
  96  * Return: valid pointer on success and error code on failure.
  97  * From ASoC DPCM framework, this state is linked to startup() operation.
  98  */
  99 struct slim_stream_runtime *slim_stream_allocate(struct slim_device *dev,
 100                                                  const char *name)
 101 {
 102         struct slim_stream_runtime *rt;
 103
 104         rt = kzalloc(sizeof(*rt), GFP_KERNEL);
 105         if (!rt)
 106                 return ERR_PTR(-ENOMEM);
 107
 108         rt->name = kasprintf(GFP_KERNEL, "slim-%s", name);
 109         if (!rt->name) {
 110                 kfree(rt);
 111                 return ERR_PTR(-ENOMEM);
 112         }
 113
 114         rt->dev = dev;
 115         spin_lock(&dev->stream_list_lock);
 116         list_add_tail(&rt->node, &dev->stream_list);
 117         spin_unlock(&dev->stream_list_lock);
 118
 119         return rt;
 120 }
 121 EXPORT_SYMBOL_GPL(slim_stream_allocate);
 122
 123 static int slim_connect_port_channel(struct slim_stream_runtime *stream,
 124                                      struct slim_port *port)
 125 {
 126         struct slim_device *sdev = stream->dev;
 127         u8 wbuf[2];
 128         struct slim_val_inf msg = {0, 2, NULL, wbuf, NULL};
 129         u8 mc = SLIM_MSG_MC_CONNECT_SOURCE;
 130         DEFINE_SLIM_LDEST_TXN(txn, mc, 6, stream->dev->laddr, &msg);
 131
 132         if (port->direction == SLIM_PORT_SINK)
 133                 txn.mc = SLIM_MSG_MC_CONNECT_SINK;
 134
 135         wbuf[0] = port->id;
 136         wbuf[1] = port->ch.id;
 137         port->ch.state = SLIM_CH_STATE_ASSOCIATED;
 138         port->state = SLIM_PORT_UNCONFIGURED;
 139
 140         return slim_do_transfer(sdev->ctrl, &txn);
 141 }
 142
 143 static int slim_disconnect_port(struct slim_stream_runtime *stream,
 144                                 struct slim_port *port)
 145 {
 146         struct slim_device *sdev = stream->dev;
 147         u8 wbuf[1];
 148         struct slim_val_inf msg = {0, 1, NULL, wbuf, NULL};
 149         u8 mc = SLIM_MSG_MC_DISCONNECT_PORT;
 150         DEFINE_SLIM_LDEST_TXN(txn, mc, 5, stream->dev->laddr, &msg);
 151
 152         wbuf[0] = port->id;
 153         port->ch.state = SLIM_CH_STATE_DISCONNECTED;
 154         port->state = SLIM_PORT_DISCONNECTED;
 155
 156         return slim_do_transfer(sdev->ctrl, &txn);
 157 }
 158
 159 static int slim_deactivate_remove_channel(struct slim_stream_runtime *stream,
 160                                           struct slim_port *port)
 161 {
 162         struct slim_device *sdev = stream->dev;
 163         u8 wbuf[1];
 164         struct slim_val_inf msg = {0, 1, NULL, wbuf, NULL};
 165         u8 mc = SLIM_MSG_MC_NEXT_DEACTIVATE_CHANNEL;
 166         DEFINE_SLIM_LDEST_TXN(txn, mc, 5, stream->dev->laddr, &msg);
 167         int ret;
 168
 169         wbuf[0] = port->ch.id;
 170         ret = slim_do_transfer(sdev->ctrl, &txn);
 171         if (ret)
 172                 return ret;
 173
 174         txn.mc = SLIM_MSG_MC_NEXT_REMOVE_CHANNEL;
 175         port->ch.state = SLIM_CH_STATE_REMOVED;
 176
 177         return slim_do_transfer(sdev->ctrl, &txn);
 178 }
 179
 180 static int slim_get_prate_code(int rate)
 181 {
 182         int i;
 183
 184         for (i = 0; i < ARRAY_SIZE(slim_presence_rate_table); i++) {
 185                 if (rate == slim_presence_rate_table[i])
 186                         return i;
 187         }
 188
 189         return -EINVAL;
 190 }
 191
 192 /*
 193  * slim_stream_prepare() - Prepare a SLIMbus Stream
 194  *
 195  * @rt: instance of slim stream runtime to configure
 196  * @cfg: new configuration for the stream
 197  *
 198  * This API will configure SLIMbus stream with config parameters from cfg.
 199  * return zero on success and error code on failure. From ASoC DPCM framework,
 200  * this state is linked to hw_params() operation.
 201  */
 202 int slim_stream_prepare(struct slim_stream_runtime *rt,
 203                         struct slim_stream_config *cfg)
 204 {
 205         struct slim_controller *ctrl = rt->dev->ctrl;
 206         struct slim_port *port;
 207         int num_ports, i, port_id;
 208
 209         if (rt->ports) {
 210                 dev_err(&rt->dev->dev, "Stream already Prepared\n");
 211                 return -EINVAL;
 212         }
 213
 214         num_ports = hweight32(cfg->port_mask);
 215         rt->ports = kcalloc(num_ports, sizeof(*port), GFP_KERNEL);
 216         if (!rt->ports)
 217                 return -ENOMEM;
 218
 219         rt->num_ports = num_ports;
 220         rt->rate = cfg->rate;
 221         rt->bps = cfg->bps;
 222         rt->direction = cfg->direction;
 223
 224         if (cfg->rate % ctrl->a_framer->superfreq) {
 225                 /*
 226                  * data rate not exactly multiple of super frame,
 227                  * use PUSH/PULL protocol
 228                  */
 229                 if (cfg->direction == SNDRV_PCM_STREAM_PLAYBACK)
 230                         rt->prot = SLIM_PROTO_PUSH;
 231                 else
 232                         rt->prot = SLIM_PROTO_PULL;
 233         } else {
 234                 rt->prot = SLIM_PROTO_ISO;
 235         }
 236
 237         rt->ratem = cfg->rate/ctrl->a_framer->superfreq;
 238
 239         i = 0;
 240         for_each_set_bit(port_id, &cfg->port_mask, SLIM_DEVICE_MAX_PORTS) {
 241                 port = &rt->ports[i];
 242                 port->state = SLIM_PORT_DISCONNECTED;
 243                 port->id = port_id;
 244                 port->ch.prrate = slim_get_prate_code(cfg->rate);
 245                 port->ch.id = cfg->chs[i];
 246                 port->ch.data_fmt = SLIM_CH_DATA_FMT_NOT_DEFINED;
 247                 port->ch.aux_fmt = SLIM_CH_AUX_FMT_NOT_APPLICABLE;
 248                 port->ch.state = SLIM_CH_STATE_ALLOCATED;
 249
 250                 if (cfg->direction == SNDRV_PCM_STREAM_PLAYBACK)
 251                         port->direction = SLIM_PORT_SINK;
 252                 else
 253                         port->direction = SLIM_PORT_SOURCE;
 254
 255                 slim_connect_port_channel(rt, port);
 256                 i++;
 257         }
 258
 259         return 0;
 260 }
 261 EXPORT_SYMBOL_GPL(slim_stream_prepare);
 262
 263 static int slim_define_channel_content(struct slim_stream_runtime *stream,
 264                                        struct slim_port *port)
 265 {
 266         struct slim_device *sdev = stream->dev;
 267         u8 wbuf[4];
 268         struct slim_val_inf msg = {0, 4, NULL, wbuf, NULL};
 269         u8 mc = SLIM_MSG_MC_NEXT_DEFINE_CONTENT;
 270         DEFINE_SLIM_LDEST_TXN(txn, mc, 8, stream->dev->laddr, &msg);
 271
 272         wbuf[0] = port->ch.id;
 273         wbuf[1] = port->ch.prrate;
 274
 275         /* Frequency Locked for ISO Protocol */
 276         if (stream->prot != SLIM_PROTO_ISO)
 277                 wbuf[1] |= SLIM_CHANNEL_CONTENT_FL;
 278
 279         wbuf[2] = port->ch.data_fmt | (port->ch.aux_fmt << 4);
 280         wbuf[3] = stream->bps/SLIM_SLOT_LEN_BITS;
 281         port->ch.state = SLIM_CH_STATE_CONTENT_DEFINED;
 282
 283         return slim_do_transfer(sdev->ctrl, &txn);
 284 }
 285
 286 static int slim_get_segdist_code(int ratem)
 287 {
 288         int i;
 289
 290         for (i = 0; i < ARRAY_SIZE(segdist_codes); i++) {
 291                 if (segdist_codes[i].ratem == ratem)
 292                         return segdist_codes[i].segdist_code;
 293         }
 294
 295         return -EINVAL;
 296 }
 297
 298 static int slim_define_channel(struct slim_stream_runtime *stream,
 299                                        struct slim_port *port)
 300 {
 301         struct slim_device *sdev = stream->dev;
 302         u8 wbuf[4];
 303         struct slim_val_inf msg = {0, 4, NULL, wbuf, NULL};
 304         u8 mc = SLIM_MSG_MC_NEXT_DEFINE_CHANNEL;
 305         DEFINE_SLIM_LDEST_TXN(txn, mc, 8, stream->dev->laddr, &msg);
 306
 307         port->ch.seg_dist = slim_get_segdist_code(stream->ratem);
 308
 309         wbuf[0] = port->ch.id;
 310         wbuf[1] = port->ch.seg_dist & 0xFF;
 311         wbuf[2] = (stream->prot << 4) | ((port->ch.seg_dist & 0xF00) >> 8);
 312         if (stream->prot == SLIM_PROTO_ISO)
 313                 wbuf[3] = stream->bps/SLIM_SLOT_LEN_BITS;
 314         else
 315                 wbuf[3] = stream->bps/SLIM_SLOT_LEN_BITS + 1;
 316
 317         port->ch.state = SLIM_CH_STATE_DEFINED;
 318
 319         return slim_do_transfer(sdev->ctrl, &txn);
 320 }
 321
 322 static int slim_activate_channel(struct slim_stream_runtime *stream,
 323                                  struct slim_port *port)
 324 {
 325         struct slim_device *sdev = stream->dev;
 326         u8 wbuf[1];
 327         struct slim_val_inf msg = {0, 1, NULL, wbuf, NULL};
 328         u8 mc = SLIM_MSG_MC_NEXT_ACTIVATE_CHANNEL;
 329         DEFINE_SLIM_LDEST_TXN(txn, mc, 5, stream->dev->laddr, &msg);
 330
 331         txn.msg->num_bytes = 1;
 332         txn.msg->wbuf = wbuf;
 333         wbuf[0] = port->ch.id;
 334         port->ch.state = SLIM_CH_STATE_ACTIVE;
 335
 336         return slim_do_transfer(sdev->ctrl, &txn);
 337 }
 338
 339 /*
 340  * slim_stream_enable() - Enable a prepared SLIMbus Stream
 341  *
 342  * @stream: instance of slim stream runtime to enable
 343  *
 344  * This API will enable all the ports and channels associated with
 345  * SLIMbus stream
 346  *
 347  * Return: zero on success and error code on failure. From ASoC DPCM framework,
 348  * this state is linked to trigger() start operation.
 349  */
 350 int slim_stream_enable(struct slim_stream_runtime *stream)
 351 {
 352         DEFINE_SLIM_BCAST_TXN(txn, SLIM_MSG_MC_BEGIN_RECONFIGURATION,
 353                                 3, SLIM_LA_MANAGER, NULL);
 354         struct slim_controller *ctrl = stream->dev->ctrl;
 355         int ret, i;
 356
 357         if (ctrl->enable_stream) {
 358                 ret = ctrl->enable_stream(stream);
 359                 if (ret)
 360                         return ret;
 361
 362                 for (i = 0; i < stream->num_ports; i++)
 363                         stream->ports[i].ch.state = SLIM_CH_STATE_ACTIVE;
 364
 365                 return ret;
 366         }
 367
 368         ret = slim_do_transfer(ctrl, &txn);
 369         if (ret)
 370                 return ret;
 371
 372         /* define channels first before activating them */
 373         for (i = 0; i < stream->num_ports; i++) {
 374                 struct slim_port *port = &stream->ports[i];
 375
 376                 slim_define_channel(stream, port);
 377                 slim_define_channel_content(stream, port);
 378         }
 379
 380         for (i = 0; i < stream->num_ports; i++) {
 381                 struct slim_port *port = &stream->ports[i];
 382
 383                 slim_activate_channel(stream, port);
 384                 port->state = SLIM_PORT_CONFIGURED;
 385         }
 386         txn.mc = SLIM_MSG_MC_RECONFIGURE_NOW;
 387
 388         return slim_do_transfer(ctrl, &txn);
 389 }
 390 EXPORT_SYMBOL_GPL(slim_stream_enable);
 391
 392 /*
 393  * slim_stream_disable() - Disable a SLIMbus Stream
 394  *
 395  * @stream: instance of slim stream runtime to disable
 396  *
 397  * This API will disable all the ports and channels associated with
 398  * SLIMbus stream
 399  *
 400  * Return: zero on success and error code on failure. From ASoC DPCM framework,
 401  * this state is linked to trigger() pause operation.
 402  */
 403 int slim_stream_disable(struct slim_stream_runtime *stream)
 404 {
 405         DEFINE_SLIM_BCAST_TXN(txn, SLIM_MSG_MC_BEGIN_RECONFIGURATION,
 406                                 3, SLIM_LA_MANAGER, NULL);
 407         struct slim_controller *ctrl = stream->dev->ctrl;
 408         int ret, i;
 409
 410         if (ctrl->disable_stream)
 411                 ctrl->disable_stream(stream);
 412
 413         ret = slim_do_transfer(ctrl, &txn);
 414         if (ret)
 415                 return ret;
 416
 417         for (i = 0; i < stream->num_ports; i++)
 418                 slim_deactivate_remove_channel(stream, &stream->ports[i]);
 419
 420         txn.mc = SLIM_MSG_MC_RECONFIGURE_NOW;
 421
 422         return slim_do_transfer(ctrl, &txn);
 423 }
 424 EXPORT_SYMBOL_GPL(slim_stream_disable);
 425
 426 /*
 427  * slim_stream_unprepare() - Un-prepare a SLIMbus Stream
 428  *
 429  * @stream: instance of slim stream runtime to unprepare
 430  *
 431  * This API will un allocate all the ports and channels associated with
 432  * SLIMbus stream
 433  *
 434  * Return: zero on success and error code on failure. From ASoC DPCM framework,
 435  * this state is linked to trigger() stop operation.
 436  */
 437 int slim_stream_unprepare(struct slim_stream_runtime *stream)
 438 {
 439         int i;
 440
 441         for (i = 0; i < stream->num_ports; i++)
 442                 slim_disconnect_port(stream, &stream->ports[i]);
 443
 444         kfree(stream->ports);
 445         stream->ports = NULL;
 446         stream->num_ports = 0;
 447
 448         return 0;
 449 }
 450 EXPORT_SYMBOL_GPL(slim_stream_unprepare);
 451
 452 /*
 453  * slim_stream_free() - Free a SLIMbus Stream
 454  *
 455  * @stream: instance of slim stream runtime to free
 456  *
 457  * This API will un allocate all the memory associated with
 458  * slim stream runtime, user is not allowed to make an dereference
 459  * to stream after this call.
 460  *
 461  * Return: zero on success and error code on failure. From ASoC DPCM framework,
 462  * this state is linked to shutdown() operation.
 463  */
 464 int slim_stream_free(struct slim_stream_runtime *stream)
 465 {
 466         struct slim_device *sdev = stream->dev;
 467
 468         spin_lock(&sdev->stream_list_lock);
 469         list_del(&stream->node);
 470         spin_unlock(&sdev->stream_list_lock);
 471
 472         kfree(stream->name);
 473         kfree(stream);
 474
 475         return 0;
 476 }
 477 EXPORT_SYMBOL_GPL(slim_stream_free);