if (!size) return -EINVAL; if (count < max_alloc) return -EINVAL; if (!max_alloc) return -EINVAL;
/* By allocating a few extra entries in our pool (one less *thanthemaximumnumberthatwillberequestedina *singleallocation),wecanalwayssatisfyrequestswithout *everworryingaboutstraddlingtheendofthepoolarray. *Iftherearen'tenoughentriesstartingatthefreeindex, *wejustallocatefreeentriesfromthebeginningofthepool.
*/
alloc_size = size_mul(count + max_alloc - 1, size);
alloc_size = kmalloc_size_roundup(alloc_size);
virt = kzalloc(alloc_size, GFP_KERNEL); if (!virt) return -ENOMEM;
pool->base = virt; /* If the allocator gave us any extra memory, use it */
pool->count = alloc_size / size;
pool->free = 0;
pool->max_alloc = max_alloc;
pool->size = size;
pool->addr = 0; /* Only used for DMA pools */
/* Home-grown DMA pool. This way we can preallocate the pool, and guarantee *allocationswillsucceed.Theimmediatecommandsinatransactioncan *requireuptomax_allocelementsfromthepool.Butweonlyallow *allocationofasingleelementfromaDMApoolatatime.
*/ int gsi_trans_pool_init_dma(struct device *dev, struct gsi_trans_pool *pool,
size_t size, u32 count, u32 max_alloc)
{
size_t total_size;
dma_addr_t addr; void *virt;
if (!size) return -EINVAL; if (count < max_alloc) return -EINVAL; if (!max_alloc) return -EINVAL;
/* The allocator will give us a power-of-2 number of pages *sufficienttosatisfyourrequest.Roundupourrequested *sizetoavoidanyunusedspaceintheallocation.Thisway *gsi_trans_pool_exit_dma()canassumethetotalallocated *sizeisexactly(count*size).
*/
total_size = PAGE_SIZE << get_order(total_size);
virt = dma_alloc_coherent(dev, total_size, &addr, GFP_KERNEL); if (!virt) return -ENOMEM;
/* Return the byte offset of the next free entry in the pool */ static u32 gsi_trans_pool_alloc_common(struct gsi_trans_pool *pool, u32 count)
{
u32 offset;
/* Allocate a contiguous block of zeroed entries from a pool */ void *gsi_trans_pool_alloc(struct gsi_trans_pool *pool, u32 count)
{ return pool->base + gsi_trans_pool_alloc_common(pool, count);
}
/* Allocate a single zeroed entry from a DMA pool */ void *gsi_trans_pool_alloc_dma(struct gsi_trans_pool *pool, dma_addr_t *addr)
{
u32 offset = gsi_trans_pool_alloc_common(pool, 1);
*addr = pool->addr + offset;
return pool->base + offset;
}
/* Map a TRE ring entry index to the transaction it is associated with */ staticvoid gsi_trans_map(struct gsi_trans *trans, u32 index)
{ struct gsi_channel *channel = &trans->gsi->channel[trans->channel_id];
/* The completion event will indicate the last TRE used */
index += trans->used_count - 1;
/* Note: index *must* be used modulo the ring count here */
channel->trans_info.map[index % channel->tre_ring.count] = trans;
}
/* Return the transaction mapped to a given ring entry */ struct gsi_trans *
gsi_channel_trans_mapped(struct gsi_channel *channel, u32 index)
{ /* Note: index *must* be used modulo the ring count here */ return channel->trans_info.map[index % channel->tre_ring.count];
}
/* Return the oldest completed transaction for a channel (or null) */ struct gsi_trans *gsi_channel_trans_complete(struct gsi_channel *channel)
{ struct gsi_trans_info *trans_info = &channel->trans_info;
u16 trans_id = trans_info->completed_id;
if (trans_id == trans_info->pending_id) {
gsi_channel_update(channel); if (trans_id == trans_info->pending_id) return NULL;
}
/* These pending transactions are now completed */
delta = trans_index - trans_info->pending_id + 1;
delta %= channel->tre_count;
trans_info->pending_id += delta;
}
/* Move a transaction from completed to polled state */ void gsi_trans_move_polled(struct gsi_trans *trans)
{ struct gsi_channel *channel = &trans->gsi->channel[trans->channel_id]; struct gsi_trans_info *trans_info = &channel->trans_info;
/* This completed transaction is now polled */
trans_info->completed_id++;
}
/* Reserve some number of TREs on a channel. Returns true if successful */ staticbool
gsi_trans_tre_reserve(struct gsi_trans_info *trans_info, u32 tre_count)
{ int avail = atomic_read(&trans_info->tre_avail); intnew;
do { new = avail - (int)tre_count; if (unlikely(new < 0)) returnfalse;
} while (!atomic_try_cmpxchg(&trans_info->tre_avail, &avail, new));
returntrue;
}
/* Release previously-reserved TRE entries to a channel */ staticvoid
gsi_trans_tre_release(struct gsi_trans_info *trans_info, u32 tre_count)
{
atomic_add(tre_count, &trans_info->tre_avail);
}
/* Return true if no transactions are allocated, false otherwise */ bool gsi_channel_trans_idle(struct gsi *gsi, u32 channel_id)
{
u32 tre_max = gsi_channel_tre_max(gsi, channel_id); struct gsi_trans_info *trans_info;
if (!refcount_dec_and_test(&trans->refcount)) return;
/* Unused transactions are allocated but never committed, pending, *completed,orpolled.
*/
trans_info = &trans->gsi->channel[trans->channel_id].trans_info; if (!trans->used_count) {
trans_info->allocated_id++;
trans_info->committed_id++;
trans_info->pending_id++;
trans_info->completed_id++;
} else {
ipa_gsi_trans_release(trans);
}
/* This transaction is now free */
trans_info->polled_id++;
/* Releasing the reserved TREs implicitly frees the sgl[] and *(ifpresent)info[]arrays,plusthetransactionitself.
*/
gsi_trans_tre_release(trans_info, trans->rsvd_count);
}
/* Add an immediate command to a transaction */ void gsi_trans_cmd_add(struct gsi_trans *trans, void *buf, u32 size,
dma_addr_t addr, enum ipa_cmd_opcode opcode)
{
u32 which = trans->used_count++; struct scatterlist *sg;
WARN_ON(which >= trans->rsvd_count);
/* Commands are quite different from data transfer requests. *Theirpayloadscomefromapoolwhosememoryisallocated *usingdma_alloc_coherent().Wethereforedo*not*mapthem *forDMA(unlikewhatwedoforpagesandskbs). * *Whenatransactioncompletes,theSGLisnormallyunmapped. *AcommandtransactionhasdirectionDMA_NONE,whichtells *gsi_trans_complete()toskiptheunmappingstep. * *Theonlythingsweusedirectlyinacommandscatter/gather *entryaretheDMAaddressandlength.WestillneedtheSG *tableflagstobemaintainedthough,soassignaNULLpage *pointerforthatpurpose.
*/
sg = &trans->sgl[which];
sg_assign_page(sg, NULL);
sg_dma_address(sg) = addr;
sg_dma_len(sg) = size;
trans->cmd_opcode[which] = opcode;
}
/* Add a page transfer to a transaction. It will fill the only TRE. */ int gsi_trans_page_add(struct gsi_trans *trans, struct page *page, u32 size,
u32 offset)
{ struct scatterlist *sg = &trans->sgl[0]; int ret;
if (WARN_ON(trans->rsvd_count != 1)) return -EINVAL; if (WARN_ON(trans->used_count)) return -EINVAL;
sg_set_page(sg, page, size, offset);
ret = dma_map_sg(trans->gsi->dev, sg, 1, trans->direction); if (!ret) return -ENOMEM;
trans->used_count++; /* Transaction now owns the (DMA mapped) page */
return0;
}
/* Add an SKB transfer to a transaction. No other TREs will be used. */ int gsi_trans_skb_add(struct gsi_trans *trans, struct sk_buff *skb)
{ struct scatterlist *sg = &trans->sgl[0];
u32 used_count; int ret;
if (WARN_ON(trans->rsvd_count != 1)) return -EINVAL; if (WARN_ON(trans->used_count)) return -EINVAL;
/* skb->len will not be 0 (checked early) */
ret = skb_to_sgvec(skb, sg, 0, skb->len); if (ret < 0) return ret;
used_count = ret;
ret = dma_map_sg(trans->gsi->dev, sg, used_count, trans->direction); if (!ret) return -ENOMEM;
/* Transaction now owns the (DMA mapped) skb */
trans->used_count += used_count;
return0;
}
/* Compute the length/opcode value to use for a TRE */ static __le16 gsi_tre_len_opcode(enum ipa_cmd_opcode opcode, u32 len)
{ return opcode == IPA_CMD_NONE ? cpu_to_le16((u16)len)
: cpu_to_le16((u16)opcode);
}
/* Compute the flags value to use for a given TRE */ static __le32 gsi_tre_flags(bool last_tre, bool bei, enum ipa_cmd_opcode opcode)
{ enum gsi_tre_type tre_type;
u32 tre_flags;
/* Last TRE contains interrupt flags */ if (last_tre) { /* All transactions end in a transfer completion interrupt */
tre_flags |= TRE_FLAGS_IEOT_FMASK; /* Don't interrupt when outbound commands are acknowledged */ if (bei)
tre_flags |= TRE_FLAGS_BEI_FMASK;
} else { /* All others indicate there's more to come */
tre_flags |= TRE_FLAGS_CHAIN_FMASK;
}
/* Consume the entries. If we cross the end of the ring while *fillingthemwe'llswitchtothebeginningtofinish. *Ifthereisnoinfoarraywe'redoingasimpledata *transferrequest,whoseopcodeisIPA_CMD_NONE.
*/
cmd_opcode = channel->command ? &trans->cmd_opcode[0] : NULL;
avail = tre_ring->count - tre_ring->index % tre_ring->count;
dest_tre = gsi_ring_virt(tre_ring, tre_ring->index);
for_each_sg(trans->sgl, sg, trans->used_count, i) { bool last_tre = i == trans->used_count - 1;
dma_addr_t addr = sg_dma_address(sg);
u32 len = sg_dma_len(sg);
byte_count += len; if (!avail--)
dest_tre = gsi_ring_virt(tre_ring, 0); if (cmd_opcode)
opcode = *cmd_opcode++;
gsi_trans_tre_fill(dest_tre, addr, len, last_tre, bei, opcode);
dest_tre++;
} /* Associate the TRE with the transaction */
gsi_trans_map(trans, tre_ring->index);
tre_ring->index += trans->used_count;
trans->len = byte_count; if (channel->toward_ipa)
gsi_trans_tx_committed(trans);
gsi_trans_move_committed(trans);
/* Ring doorbell if requested, or if all TREs are allocated */ if (ring_db || !atomic_read(&channel->trans_info.tre_avail)) { /* Report what we're handing off to hardware for TX channels */ if (channel->toward_ipa)
gsi_trans_tx_queued(trans);
gsi_trans_move_pending(trans);
gsi_channel_doorbell(channel);
}
}
/* Commit a GSI transaction */ void gsi_trans_commit(struct gsi_trans *trans, bool ring_db)
{ if (trans->used_count)
__gsi_trans_commit(trans, ring_db); else
gsi_trans_free(trans);
}
/* Commit a GSI transaction and wait for it to complete */ void gsi_trans_commit_wait(struct gsi_trans *trans)
{ if (!trans->used_count) goto out_trans_free;
refcount_inc(&trans->refcount);
__gsi_trans_commit(trans, true);
wait_for_completion(&trans->completion);
out_trans_free:
gsi_trans_free(trans);
}
/* Process the completion of a transaction; called while polling */ void gsi_trans_complete(struct gsi_trans *trans)
{ /* If the entire SGL was mapped when added, unmap it now */ if (trans->direction != DMA_NONE)
dma_unmap_sg(trans->gsi->dev, trans->sgl, trans->used_count,
trans->direction);
/* Mark a gsi_trans_read_byte() request done */ void gsi_trans_read_byte_done(struct gsi *gsi, u32 channel_id)
{ struct gsi_channel *channel = &gsi->channel[channel_id];
gsi_trans_tre_release(&channel->trans_info, 1);
}
/* Initialize a channel's GSI transaction info */ int gsi_channel_trans_init(struct gsi *gsi, u32 channel_id)
{ struct gsi_channel *channel = &gsi->channel[channel_id];
u32 tre_count = channel->tre_count; struct gsi_trans_info *trans_info;
u32 tre_max; int ret;
/* Ensure the size of a channel element is what's expected */
BUILD_BUG_ON(sizeof(struct gsi_tre) != GSI_RING_ELEMENT_SIZE);
trans_info = &channel->trans_info;
/* The tre_avail field is what ultimately limits the number of *outstandingtransactionsandtheirresources.Atransaction *allocationsucceedsonlyiftheTREsavailablearesufficient *forwhatthetransactionmightneed.
*/
tre_max = gsi_channel_tre_max(channel->gsi, channel_id);
atomic_set(&trans_info->tre_avail, tre_max);
/* We can't use more TREs than the number available in the ring. *Thislimitsthenumberoftransactionsthatcanbeoutstanding. *WorstcaseisoneTREpertransaction(butweactuallylimit *ittosomethingalittlelessthanthat).Byallocatinga *power-of-twonumberoftransactionswecanuseanindex *modulothatnumbertodeterminethenextonethat'sfree. *Transactionsareallocatedoneatatime.
*/
trans_info->trans = kcalloc(tre_count, sizeof(*trans_info->trans),
GFP_KERNEL); if (!trans_info->trans) return -ENOMEM;
trans_info->free_id = 0; /* all modulo channel->tre_count */
trans_info->allocated_id = 0;
trans_info->committed_id = 0;
trans_info->pending_id = 0;
trans_info->completed_id = 0;
trans_info->polled_id = 0;
/* A completion event contains a pointer to the TRE that caused *theevent(whichwillbethelastoneusedbythetransaction). *Eachentryinthismaprecordsthetransactionassociated *withacorrespondingcompletedTRE.
*/
trans_info->map = kcalloc(tre_count, sizeof(*trans_info->map),
GFP_KERNEL); if (!trans_info->map) {
ret = -ENOMEM; goto err_trans_free;
}
/* A transaction uses a scatterlist array to represent the data *transfersimplementedbythetransaction.Eachscatterlist *elementisusedtofillasingleTREwhenthetransactionis *committed.Soweneedasmanyscatterlistelementsasthe *maximumnumberofTREsthatcanbeoutstanding.
*/
ret = gsi_trans_pool_init(&trans_info->sg_pool, sizeof(struct scatterlist),
tre_max, channel->trans_tre_max); if (ret) goto err_map_free;
Die Informationen auf dieser Webseite wurden
nach bestem Wissen sorgfältig zusammengestellt. Es wird jedoch weder Vollständigkeit, noch Richtigkeit,
noch Qualität der bereit gestellten Informationen zugesichert.
Bemerkung:
Die farbliche Syntaxdarstellung und die Messung sind noch experimentell.