906 lines
24 KiB
C
906 lines
24 KiB
C
/*
|
|
* Copyright © 2016-2017 Intel Corporation
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a
|
|
* copy of this software and associated documentation files (the "Software"),
|
|
* to deal in the Software without restriction, including without limitation
|
|
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
|
|
* and/or sell copies of the Software, and to permit persons to whom the
|
|
* Software is furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice (including the next
|
|
* paragraph) shall be included in all copies or substantial portions of the
|
|
* Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
|
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
|
|
* IN THE SOFTWARE.
|
|
*/
|
|
|
|
#include "i915_drv.h"
|
|
#include "intel_guc_ct.h"
|
|
|
|
#ifdef CONFIG_DRM_I915_DEBUG_GUC
|
|
#define CT_DEBUG_DRIVER(...) DRM_DEBUG_DRIVER(__VA_ARGS__)
|
|
#else
|
|
#define CT_DEBUG_DRIVER(...) do { } while (0)
|
|
#endif
|
|
|
|
struct ct_request {
|
|
struct list_head link;
|
|
u32 fence;
|
|
u32 status;
|
|
u32 response_len;
|
|
u32 *response_buf;
|
|
};
|
|
|
|
struct ct_incoming_request {
|
|
struct list_head link;
|
|
u32 msg[];
|
|
};
|
|
|
|
enum { CTB_SEND = 0, CTB_RECV = 1 };
|
|
|
|
enum { CTB_OWNER_HOST = 0 };
|
|
|
|
static void ct_incoming_request_worker_func(struct work_struct *w);
|
|
|
|
/**
|
|
* intel_guc_ct_init_early - Initialize CT state without requiring device access
|
|
* @ct: pointer to CT struct
|
|
*/
|
|
void intel_guc_ct_init_early(struct intel_guc_ct *ct)
|
|
{
|
|
/* we're using static channel owners */
|
|
ct->host_channel.owner = CTB_OWNER_HOST;
|
|
|
|
spin_lock_init(&ct->lock);
|
|
INIT_LIST_HEAD(&ct->pending_requests);
|
|
INIT_LIST_HEAD(&ct->incoming_requests);
|
|
INIT_WORK(&ct->worker, ct_incoming_request_worker_func);
|
|
}
|
|
|
|
static inline struct intel_guc *ct_to_guc(struct intel_guc_ct *ct)
|
|
{
|
|
return container_of(ct, struct intel_guc, ct);
|
|
}
|
|
|
|
static inline const char *guc_ct_buffer_type_to_str(u32 type)
|
|
{
|
|
switch (type) {
|
|
case INTEL_GUC_CT_BUFFER_TYPE_SEND:
|
|
return "SEND";
|
|
case INTEL_GUC_CT_BUFFER_TYPE_RECV:
|
|
return "RECV";
|
|
default:
|
|
return "<invalid>";
|
|
}
|
|
}
|
|
|
|
static void guc_ct_buffer_desc_init(struct guc_ct_buffer_desc *desc,
|
|
u32 cmds_addr, u32 size, u32 owner)
|
|
{
|
|
CT_DEBUG_DRIVER("CT: desc %p init addr=%#x size=%u owner=%u\n",
|
|
desc, cmds_addr, size, owner);
|
|
memset(desc, 0, sizeof(*desc));
|
|
desc->addr = cmds_addr;
|
|
desc->size = size;
|
|
desc->owner = owner;
|
|
}
|
|
|
|
static void guc_ct_buffer_desc_reset(struct guc_ct_buffer_desc *desc)
|
|
{
|
|
CT_DEBUG_DRIVER("CT: desc %p reset head=%u tail=%u\n",
|
|
desc, desc->head, desc->tail);
|
|
desc->head = 0;
|
|
desc->tail = 0;
|
|
desc->is_in_error = 0;
|
|
}
|
|
|
|
static int guc_action_register_ct_buffer(struct intel_guc *guc,
|
|
u32 desc_addr,
|
|
u32 type)
|
|
{
|
|
u32 action[] = {
|
|
INTEL_GUC_ACTION_REGISTER_COMMAND_TRANSPORT_BUFFER,
|
|
desc_addr,
|
|
sizeof(struct guc_ct_buffer_desc),
|
|
type
|
|
};
|
|
int err;
|
|
|
|
/* Can't use generic send(), CT registration must go over MMIO */
|
|
err = intel_guc_send_mmio(guc, action, ARRAY_SIZE(action), NULL, 0);
|
|
if (err)
|
|
DRM_ERROR("CT: register %s buffer failed; err=%d\n",
|
|
guc_ct_buffer_type_to_str(type), err);
|
|
return err;
|
|
}
|
|
|
|
static int guc_action_deregister_ct_buffer(struct intel_guc *guc,
|
|
u32 owner,
|
|
u32 type)
|
|
{
|
|
u32 action[] = {
|
|
INTEL_GUC_ACTION_DEREGISTER_COMMAND_TRANSPORT_BUFFER,
|
|
owner,
|
|
type
|
|
};
|
|
int err;
|
|
|
|
/* Can't use generic send(), CT deregistration must go over MMIO */
|
|
err = intel_guc_send_mmio(guc, action, ARRAY_SIZE(action), NULL, 0);
|
|
if (err)
|
|
DRM_ERROR("CT: deregister %s buffer failed; owner=%d err=%d\n",
|
|
guc_ct_buffer_type_to_str(type), owner, err);
|
|
return err;
|
|
}
|
|
|
|
static bool ctch_is_open(struct intel_guc_ct_channel *ctch)
|
|
{
|
|
return ctch->vma != NULL;
|
|
}
|
|
|
|
static int ctch_init(struct intel_guc *guc,
|
|
struct intel_guc_ct_channel *ctch)
|
|
{
|
|
struct i915_vma *vma;
|
|
void *blob;
|
|
int err;
|
|
int i;
|
|
|
|
GEM_BUG_ON(ctch->vma);
|
|
|
|
/* We allocate 1 page to hold both descriptors and both buffers.
|
|
* ___________.....................
|
|
* |desc (SEND)| :
|
|
* |___________| PAGE/4
|
|
* :___________....................:
|
|
* |desc (RECV)| :
|
|
* |___________| PAGE/4
|
|
* :_______________________________:
|
|
* |cmds (SEND) |
|
|
* | PAGE/4
|
|
* |_______________________________|
|
|
* |cmds (RECV) |
|
|
* | PAGE/4
|
|
* |_______________________________|
|
|
*
|
|
* Each message can use a maximum of 32 dwords and we don't expect to
|
|
* have more than 1 in flight at any time, so we have enough space.
|
|
* Some logic further ahead will rely on the fact that there is only 1
|
|
* page and that it is always mapped, so if the size is changed the
|
|
* other code will need updating as well.
|
|
*/
|
|
|
|
/* allocate vma */
|
|
vma = intel_guc_allocate_vma(guc, PAGE_SIZE);
|
|
if (IS_ERR(vma)) {
|
|
err = PTR_ERR(vma);
|
|
goto err_out;
|
|
}
|
|
ctch->vma = vma;
|
|
|
|
/* map first page */
|
|
blob = i915_gem_object_pin_map(vma->obj, I915_MAP_WB);
|
|
if (IS_ERR(blob)) {
|
|
err = PTR_ERR(blob);
|
|
goto err_vma;
|
|
}
|
|
CT_DEBUG_DRIVER("CT: vma base=%#x\n",
|
|
intel_guc_ggtt_offset(guc, ctch->vma));
|
|
|
|
/* store pointers to desc and cmds */
|
|
for (i = 0; i < ARRAY_SIZE(ctch->ctbs); i++) {
|
|
GEM_BUG_ON((i != CTB_SEND) && (i != CTB_RECV));
|
|
ctch->ctbs[i].desc = blob + PAGE_SIZE/4 * i;
|
|
ctch->ctbs[i].cmds = blob + PAGE_SIZE/4 * i + PAGE_SIZE/2;
|
|
}
|
|
|
|
return 0;
|
|
|
|
err_vma:
|
|
i915_vma_unpin_and_release(&ctch->vma);
|
|
err_out:
|
|
CT_DEBUG_DRIVER("CT: channel %d initialization failed; err=%d\n",
|
|
ctch->owner, err);
|
|
return err;
|
|
}
|
|
|
|
static void ctch_fini(struct intel_guc *guc,
|
|
struct intel_guc_ct_channel *ctch)
|
|
{
|
|
GEM_BUG_ON(!ctch->vma);
|
|
|
|
i915_gem_object_unpin_map(ctch->vma->obj);
|
|
i915_vma_unpin_and_release(&ctch->vma);
|
|
}
|
|
|
|
static int ctch_open(struct intel_guc *guc,
|
|
struct intel_guc_ct_channel *ctch)
|
|
{
|
|
u32 base;
|
|
int err;
|
|
int i;
|
|
|
|
CT_DEBUG_DRIVER("CT: channel %d reopen=%s\n",
|
|
ctch->owner, yesno(ctch_is_open(ctch)));
|
|
|
|
if (!ctch->vma) {
|
|
err = ctch_init(guc, ctch);
|
|
if (unlikely(err))
|
|
goto err_out;
|
|
GEM_BUG_ON(!ctch->vma);
|
|
}
|
|
|
|
/* vma should be already allocated and map'ed */
|
|
base = intel_guc_ggtt_offset(guc, ctch->vma);
|
|
|
|
/* (re)initialize descriptors
|
|
* cmds buffers are in the second half of the blob page
|
|
*/
|
|
for (i = 0; i < ARRAY_SIZE(ctch->ctbs); i++) {
|
|
GEM_BUG_ON((i != CTB_SEND) && (i != CTB_RECV));
|
|
guc_ct_buffer_desc_init(ctch->ctbs[i].desc,
|
|
base + PAGE_SIZE/4 * i + PAGE_SIZE/2,
|
|
PAGE_SIZE/4,
|
|
ctch->owner);
|
|
}
|
|
|
|
/* register buffers, starting wirh RECV buffer
|
|
* descriptors are in first half of the blob
|
|
*/
|
|
err = guc_action_register_ct_buffer(guc,
|
|
base + PAGE_SIZE/4 * CTB_RECV,
|
|
INTEL_GUC_CT_BUFFER_TYPE_RECV);
|
|
if (unlikely(err))
|
|
goto err_fini;
|
|
|
|
err = guc_action_register_ct_buffer(guc,
|
|
base + PAGE_SIZE/4 * CTB_SEND,
|
|
INTEL_GUC_CT_BUFFER_TYPE_SEND);
|
|
if (unlikely(err))
|
|
goto err_deregister;
|
|
|
|
return 0;
|
|
|
|
err_deregister:
|
|
guc_action_deregister_ct_buffer(guc,
|
|
ctch->owner,
|
|
INTEL_GUC_CT_BUFFER_TYPE_RECV);
|
|
err_fini:
|
|
ctch_fini(guc, ctch);
|
|
err_out:
|
|
DRM_ERROR("CT: can't open channel %d; err=%d\n", ctch->owner, err);
|
|
return err;
|
|
}
|
|
|
|
static void ctch_close(struct intel_guc *guc,
|
|
struct intel_guc_ct_channel *ctch)
|
|
{
|
|
GEM_BUG_ON(!ctch_is_open(ctch));
|
|
|
|
guc_action_deregister_ct_buffer(guc,
|
|
ctch->owner,
|
|
INTEL_GUC_CT_BUFFER_TYPE_SEND);
|
|
guc_action_deregister_ct_buffer(guc,
|
|
ctch->owner,
|
|
INTEL_GUC_CT_BUFFER_TYPE_RECV);
|
|
ctch_fini(guc, ctch);
|
|
}
|
|
|
|
static u32 ctch_get_next_fence(struct intel_guc_ct_channel *ctch)
|
|
{
|
|
/* For now it's trivial */
|
|
return ++ctch->next_fence;
|
|
}
|
|
|
|
/**
|
|
* DOC: CTB Host to GuC request
|
|
*
|
|
* Format of the CTB Host to GuC request message is as follows::
|
|
*
|
|
* +------------+---------+---------+---------+---------+
|
|
* | msg[0] | [1] | [2] | ... | [n-1] |
|
|
* +------------+---------+---------+---------+---------+
|
|
* | MESSAGE | MESSAGE PAYLOAD |
|
|
* + HEADER +---------+---------+---------+---------+
|
|
* | | 0 | 1 | ... | n |
|
|
* +============+=========+=========+=========+=========+
|
|
* | len >= 1 | FENCE | request specific data |
|
|
* +------+-----+---------+---------+---------+---------+
|
|
*
|
|
* ^-----------------len-------------------^
|
|
*/
|
|
|
|
static int ctb_write(struct intel_guc_ct_buffer *ctb,
|
|
const u32 *action,
|
|
u32 len /* in dwords */,
|
|
u32 fence,
|
|
bool want_response)
|
|
{
|
|
struct guc_ct_buffer_desc *desc = ctb->desc;
|
|
u32 head = desc->head / 4; /* in dwords */
|
|
u32 tail = desc->tail / 4; /* in dwords */
|
|
u32 size = desc->size / 4; /* in dwords */
|
|
u32 used; /* in dwords */
|
|
u32 header;
|
|
u32 *cmds = ctb->cmds;
|
|
unsigned int i;
|
|
|
|
GEM_BUG_ON(desc->size % 4);
|
|
GEM_BUG_ON(desc->head % 4);
|
|
GEM_BUG_ON(desc->tail % 4);
|
|
GEM_BUG_ON(tail >= size);
|
|
|
|
/*
|
|
* tail == head condition indicates empty. GuC FW does not support
|
|
* using up the entire buffer to get tail == head meaning full.
|
|
*/
|
|
if (tail < head)
|
|
used = (size - head) + tail;
|
|
else
|
|
used = tail - head;
|
|
|
|
/* make sure there is a space including extra dw for the fence */
|
|
if (unlikely(used + len + 1 >= size))
|
|
return -ENOSPC;
|
|
|
|
/*
|
|
* Write the message. The format is the following:
|
|
* DW0: header (including action code)
|
|
* DW1: fence
|
|
* DW2+: action data
|
|
*/
|
|
header = (len << GUC_CT_MSG_LEN_SHIFT) |
|
|
(GUC_CT_MSG_WRITE_FENCE_TO_DESC) |
|
|
(want_response ? GUC_CT_MSG_SEND_STATUS : 0) |
|
|
(action[0] << GUC_CT_MSG_ACTION_SHIFT);
|
|
|
|
CT_DEBUG_DRIVER("CT: writing %*ph %*ph %*ph\n",
|
|
4, &header, 4, &fence,
|
|
4 * (len - 1), &action[1]);
|
|
|
|
cmds[tail] = header;
|
|
tail = (tail + 1) % size;
|
|
|
|
cmds[tail] = fence;
|
|
tail = (tail + 1) % size;
|
|
|
|
for (i = 1; i < len; i++) {
|
|
cmds[tail] = action[i];
|
|
tail = (tail + 1) % size;
|
|
}
|
|
|
|
/* now update desc tail (back in bytes) */
|
|
desc->tail = tail * 4;
|
|
GEM_BUG_ON(desc->tail > desc->size);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* wait_for_ctb_desc_update - Wait for the CT buffer descriptor update.
|
|
* @desc: buffer descriptor
|
|
* @fence: response fence
|
|
* @status: placeholder for status
|
|
*
|
|
* Guc will update CT buffer descriptor with new fence and status
|
|
* after processing the command identified by the fence. Wait for
|
|
* specified fence and then read from the descriptor status of the
|
|
* command.
|
|
*
|
|
* Return:
|
|
* * 0 response received (status is valid)
|
|
* * -ETIMEDOUT no response within hardcoded timeout
|
|
* * -EPROTO no response, CT buffer is in error
|
|
*/
|
|
static int wait_for_ctb_desc_update(struct guc_ct_buffer_desc *desc,
|
|
u32 fence,
|
|
u32 *status)
|
|
{
|
|
int err;
|
|
|
|
/*
|
|
* Fast commands should complete in less than 10us, so sample quickly
|
|
* up to that length of time, then switch to a slower sleep-wait loop.
|
|
* No GuC command should ever take longer than 10ms.
|
|
*/
|
|
#define done (READ_ONCE(desc->fence) == fence)
|
|
err = wait_for_us(done, 10);
|
|
if (err)
|
|
err = wait_for(done, 10);
|
|
#undef done
|
|
|
|
if (unlikely(err)) {
|
|
DRM_ERROR("CT: fence %u failed; reported fence=%u\n",
|
|
fence, desc->fence);
|
|
|
|
if (WARN_ON(desc->is_in_error)) {
|
|
/* Something went wrong with the messaging, try to reset
|
|
* the buffer and hope for the best
|
|
*/
|
|
guc_ct_buffer_desc_reset(desc);
|
|
err = -EPROTO;
|
|
}
|
|
}
|
|
|
|
*status = desc->status;
|
|
return err;
|
|
}
|
|
|
|
/**
|
|
* wait_for_ct_request_update - Wait for CT request state update.
|
|
* @req: pointer to pending request
|
|
* @status: placeholder for status
|
|
*
|
|
* For each sent request, Guc shall send bac CT response message.
|
|
* Our message handler will update status of tracked request once
|
|
* response message with given fence is received. Wait here and
|
|
* check for valid response status value.
|
|
*
|
|
* Return:
|
|
* * 0 response received (status is valid)
|
|
* * -ETIMEDOUT no response within hardcoded timeout
|
|
*/
|
|
static int wait_for_ct_request_update(struct ct_request *req, u32 *status)
|
|
{
|
|
int err;
|
|
|
|
/*
|
|
* Fast commands should complete in less than 10us, so sample quickly
|
|
* up to that length of time, then switch to a slower sleep-wait loop.
|
|
* No GuC command should ever take longer than 10ms.
|
|
*/
|
|
#define done INTEL_GUC_MSG_IS_RESPONSE(READ_ONCE(req->status))
|
|
err = wait_for_us(done, 10);
|
|
if (err)
|
|
err = wait_for(done, 10);
|
|
#undef done
|
|
|
|
if (unlikely(err))
|
|
DRM_ERROR("CT: fence %u err %d\n", req->fence, err);
|
|
|
|
*status = req->status;
|
|
return err;
|
|
}
|
|
|
|
static int ctch_send(struct intel_guc_ct *ct,
|
|
struct intel_guc_ct_channel *ctch,
|
|
const u32 *action,
|
|
u32 len,
|
|
u32 *response_buf,
|
|
u32 response_buf_size,
|
|
u32 *status)
|
|
{
|
|
struct intel_guc_ct_buffer *ctb = &ctch->ctbs[CTB_SEND];
|
|
struct guc_ct_buffer_desc *desc = ctb->desc;
|
|
struct ct_request request;
|
|
unsigned long flags;
|
|
u32 fence;
|
|
int err;
|
|
|
|
GEM_BUG_ON(!ctch_is_open(ctch));
|
|
GEM_BUG_ON(!len);
|
|
GEM_BUG_ON(len & ~GUC_CT_MSG_LEN_MASK);
|
|
GEM_BUG_ON(!response_buf && response_buf_size);
|
|
|
|
fence = ctch_get_next_fence(ctch);
|
|
request.fence = fence;
|
|
request.status = 0;
|
|
request.response_len = response_buf_size;
|
|
request.response_buf = response_buf;
|
|
|
|
spin_lock_irqsave(&ct->lock, flags);
|
|
list_add_tail(&request.link, &ct->pending_requests);
|
|
spin_unlock_irqrestore(&ct->lock, flags);
|
|
|
|
err = ctb_write(ctb, action, len, fence, !!response_buf);
|
|
if (unlikely(err))
|
|
goto unlink;
|
|
|
|
intel_guc_notify(ct_to_guc(ct));
|
|
|
|
if (response_buf)
|
|
err = wait_for_ct_request_update(&request, status);
|
|
else
|
|
err = wait_for_ctb_desc_update(desc, fence, status);
|
|
if (unlikely(err))
|
|
goto unlink;
|
|
|
|
if (!INTEL_GUC_MSG_IS_RESPONSE_SUCCESS(*status)) {
|
|
err = -EIO;
|
|
goto unlink;
|
|
}
|
|
|
|
if (response_buf) {
|
|
/* There shall be no data in the status */
|
|
WARN_ON(INTEL_GUC_MSG_TO_DATA(request.status));
|
|
/* Return actual response len */
|
|
err = request.response_len;
|
|
} else {
|
|
/* There shall be no response payload */
|
|
WARN_ON(request.response_len);
|
|
/* Return data decoded from the status dword */
|
|
err = INTEL_GUC_MSG_TO_DATA(*status);
|
|
}
|
|
|
|
unlink:
|
|
spin_lock_irqsave(&ct->lock, flags);
|
|
list_del(&request.link);
|
|
spin_unlock_irqrestore(&ct->lock, flags);
|
|
|
|
return err;
|
|
}
|
|
|
|
/*
|
|
* Command Transport (CT) buffer based GuC send function.
|
|
*/
|
|
static int intel_guc_send_ct(struct intel_guc *guc, const u32 *action, u32 len,
|
|
u32 *response_buf, u32 response_buf_size)
|
|
{
|
|
struct intel_guc_ct *ct = &guc->ct;
|
|
struct intel_guc_ct_channel *ctch = &ct->host_channel;
|
|
u32 status = ~0; /* undefined */
|
|
int ret;
|
|
|
|
mutex_lock(&guc->send_mutex);
|
|
|
|
ret = ctch_send(ct, ctch, action, len, response_buf, response_buf_size,
|
|
&status);
|
|
if (unlikely(ret < 0)) {
|
|
DRM_ERROR("CT: send action %#X failed; err=%d status=%#X\n",
|
|
action[0], ret, status);
|
|
} else if (unlikely(ret)) {
|
|
CT_DEBUG_DRIVER("CT: send action %#x returned %d (%#x)\n",
|
|
action[0], ret, ret);
|
|
}
|
|
|
|
mutex_unlock(&guc->send_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static inline unsigned int ct_header_get_len(u32 header)
|
|
{
|
|
return (header >> GUC_CT_MSG_LEN_SHIFT) & GUC_CT_MSG_LEN_MASK;
|
|
}
|
|
|
|
static inline unsigned int ct_header_get_action(u32 header)
|
|
{
|
|
return (header >> GUC_CT_MSG_ACTION_SHIFT) & GUC_CT_MSG_ACTION_MASK;
|
|
}
|
|
|
|
static inline bool ct_header_is_response(u32 header)
|
|
{
|
|
return ct_header_get_action(header) == INTEL_GUC_ACTION_DEFAULT;
|
|
}
|
|
|
|
static int ctb_read(struct intel_guc_ct_buffer *ctb, u32 *data)
|
|
{
|
|
struct guc_ct_buffer_desc *desc = ctb->desc;
|
|
u32 head = desc->head / 4; /* in dwords */
|
|
u32 tail = desc->tail / 4; /* in dwords */
|
|
u32 size = desc->size / 4; /* in dwords */
|
|
u32 *cmds = ctb->cmds;
|
|
s32 available; /* in dwords */
|
|
unsigned int len;
|
|
unsigned int i;
|
|
|
|
GEM_BUG_ON(desc->size % 4);
|
|
GEM_BUG_ON(desc->head % 4);
|
|
GEM_BUG_ON(desc->tail % 4);
|
|
GEM_BUG_ON(tail >= size);
|
|
GEM_BUG_ON(head >= size);
|
|
|
|
/* tail == head condition indicates empty */
|
|
available = tail - head;
|
|
if (unlikely(available == 0))
|
|
return -ENODATA;
|
|
|
|
/* beware of buffer wrap case */
|
|
if (unlikely(available < 0))
|
|
available += size;
|
|
CT_DEBUG_DRIVER("CT: available %d (%u:%u)\n", available, head, tail);
|
|
GEM_BUG_ON(available < 0);
|
|
|
|
data[0] = cmds[head];
|
|
head = (head + 1) % size;
|
|
|
|
/* message len with header */
|
|
len = ct_header_get_len(data[0]) + 1;
|
|
if (unlikely(len > (u32)available)) {
|
|
DRM_ERROR("CT: incomplete message %*ph %*ph %*ph\n",
|
|
4, data,
|
|
4 * (head + available - 1 > size ?
|
|
size - head : available - 1), &cmds[head],
|
|
4 * (head + available - 1 > size ?
|
|
available - 1 - size + head : 0), &cmds[0]);
|
|
return -EPROTO;
|
|
}
|
|
|
|
for (i = 1; i < len; i++) {
|
|
data[i] = cmds[head];
|
|
head = (head + 1) % size;
|
|
}
|
|
CT_DEBUG_DRIVER("CT: received %*ph\n", 4 * len, data);
|
|
|
|
desc->head = head * 4;
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* DOC: CTB GuC to Host response
|
|
*
|
|
* Format of the CTB GuC to Host response message is as follows::
|
|
*
|
|
* +------------+---------+---------+---------+---------+---------+
|
|
* | msg[0] | [1] | [2] | [3] | ... | [n-1] |
|
|
* +------------+---------+---------+---------+---------+---------+
|
|
* | MESSAGE | MESSAGE PAYLOAD |
|
|
* + HEADER +---------+---------+---------+---------+---------+
|
|
* | | 0 | 1 | 2 | ... | n |
|
|
* +============+=========+=========+=========+=========+=========+
|
|
* | len >= 2 | FENCE | STATUS | response specific data |
|
|
* +------+-----+---------+---------+---------+---------+---------+
|
|
*
|
|
* ^-----------------------len-----------------------^
|
|
*/
|
|
|
|
static int ct_handle_response(struct intel_guc_ct *ct, const u32 *msg)
|
|
{
|
|
u32 header = msg[0];
|
|
u32 len = ct_header_get_len(header);
|
|
u32 msglen = len + 1; /* total message length including header */
|
|
u32 fence;
|
|
u32 status;
|
|
u32 datalen;
|
|
struct ct_request *req;
|
|
bool found = false;
|
|
|
|
GEM_BUG_ON(!ct_header_is_response(header));
|
|
GEM_BUG_ON(!in_irq());
|
|
|
|
/* Response payload shall at least include fence and status */
|
|
if (unlikely(len < 2)) {
|
|
DRM_ERROR("CT: corrupted response %*ph\n", 4 * msglen, msg);
|
|
return -EPROTO;
|
|
}
|
|
|
|
fence = msg[1];
|
|
status = msg[2];
|
|
datalen = len - 2;
|
|
|
|
/* Format of the status follows RESPONSE message */
|
|
if (unlikely(!INTEL_GUC_MSG_IS_RESPONSE(status))) {
|
|
DRM_ERROR("CT: corrupted response %*ph\n", 4 * msglen, msg);
|
|
return -EPROTO;
|
|
}
|
|
|
|
CT_DEBUG_DRIVER("CT: response fence %u status %#x\n", fence, status);
|
|
|
|
spin_lock(&ct->lock);
|
|
list_for_each_entry(req, &ct->pending_requests, link) {
|
|
if (unlikely(fence != req->fence)) {
|
|
CT_DEBUG_DRIVER("CT: request %u awaits response\n",
|
|
req->fence);
|
|
continue;
|
|
}
|
|
if (unlikely(datalen > req->response_len)) {
|
|
DRM_ERROR("CT: response %u too long %*ph\n",
|
|
req->fence, 4 * msglen, msg);
|
|
datalen = 0;
|
|
}
|
|
if (datalen)
|
|
memcpy(req->response_buf, msg + 3, 4 * datalen);
|
|
req->response_len = datalen;
|
|
WRITE_ONCE(req->status, status);
|
|
found = true;
|
|
break;
|
|
}
|
|
spin_unlock(&ct->lock);
|
|
|
|
if (!found)
|
|
DRM_ERROR("CT: unsolicited response %*ph\n", 4 * msglen, msg);
|
|
return 0;
|
|
}
|
|
|
|
static void ct_process_request(struct intel_guc_ct *ct,
|
|
u32 action, u32 len, const u32 *payload)
|
|
{
|
|
struct intel_guc *guc = ct_to_guc(ct);
|
|
|
|
CT_DEBUG_DRIVER("CT: request %x %*ph\n", action, 4 * len, payload);
|
|
|
|
switch (action) {
|
|
case INTEL_GUC_ACTION_DEFAULT:
|
|
if (unlikely(len < 1))
|
|
goto fail_unexpected;
|
|
intel_guc_to_host_process_recv_msg(guc, *payload);
|
|
break;
|
|
|
|
default:
|
|
fail_unexpected:
|
|
DRM_ERROR("CT: unexpected request %x %*ph\n",
|
|
action, 4 * len, payload);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static bool ct_process_incoming_requests(struct intel_guc_ct *ct)
|
|
{
|
|
unsigned long flags;
|
|
struct ct_incoming_request *request;
|
|
u32 header;
|
|
u32 *payload;
|
|
bool done;
|
|
|
|
spin_lock_irqsave(&ct->lock, flags);
|
|
request = list_first_entry_or_null(&ct->incoming_requests,
|
|
struct ct_incoming_request, link);
|
|
if (request)
|
|
list_del(&request->link);
|
|
done = !!list_empty(&ct->incoming_requests);
|
|
spin_unlock_irqrestore(&ct->lock, flags);
|
|
|
|
if (!request)
|
|
return true;
|
|
|
|
header = request->msg[0];
|
|
payload = &request->msg[1];
|
|
ct_process_request(ct,
|
|
ct_header_get_action(header),
|
|
ct_header_get_len(header),
|
|
payload);
|
|
|
|
kfree(request);
|
|
return done;
|
|
}
|
|
|
|
static void ct_incoming_request_worker_func(struct work_struct *w)
|
|
{
|
|
struct intel_guc_ct *ct = container_of(w, struct intel_guc_ct, worker);
|
|
bool done;
|
|
|
|
done = ct_process_incoming_requests(ct);
|
|
if (!done)
|
|
queue_work(system_unbound_wq, &ct->worker);
|
|
}
|
|
|
|
/**
|
|
* DOC: CTB GuC to Host request
|
|
*
|
|
* Format of the CTB GuC to Host request message is as follows::
|
|
*
|
|
* +------------+---------+---------+---------+---------+---------+
|
|
* | msg[0] | [1] | [2] | [3] | ... | [n-1] |
|
|
* +------------+---------+---------+---------+---------+---------+
|
|
* | MESSAGE | MESSAGE PAYLOAD |
|
|
* + HEADER +---------+---------+---------+---------+---------+
|
|
* | | 0 | 1 | 2 | ... | n |
|
|
* +============+=========+=========+=========+=========+=========+
|
|
* | len | request specific data |
|
|
* +------+-----+---------+---------+---------+---------+---------+
|
|
*
|
|
* ^-----------------------len-----------------------^
|
|
*/
|
|
|
|
static int ct_handle_request(struct intel_guc_ct *ct, const u32 *msg)
|
|
{
|
|
u32 header = msg[0];
|
|
u32 len = ct_header_get_len(header);
|
|
u32 msglen = len + 1; /* total message length including header */
|
|
struct ct_incoming_request *request;
|
|
unsigned long flags;
|
|
|
|
GEM_BUG_ON(ct_header_is_response(header));
|
|
|
|
request = kmalloc(sizeof(*request) + 4 * msglen, GFP_ATOMIC);
|
|
if (unlikely(!request)) {
|
|
DRM_ERROR("CT: dropping request %*ph\n", 4 * msglen, msg);
|
|
return 0; /* XXX: -ENOMEM ? */
|
|
}
|
|
memcpy(request->msg, msg, 4 * msglen);
|
|
|
|
spin_lock_irqsave(&ct->lock, flags);
|
|
list_add_tail(&request->link, &ct->incoming_requests);
|
|
spin_unlock_irqrestore(&ct->lock, flags);
|
|
|
|
queue_work(system_unbound_wq, &ct->worker);
|
|
return 0;
|
|
}
|
|
|
|
static void ct_process_host_channel(struct intel_guc_ct *ct)
|
|
{
|
|
struct intel_guc_ct_channel *ctch = &ct->host_channel;
|
|
struct intel_guc_ct_buffer *ctb = &ctch->ctbs[CTB_RECV];
|
|
u32 msg[GUC_CT_MSG_LEN_MASK + 1]; /* one extra dw for the header */
|
|
int err = 0;
|
|
|
|
if (!ctch_is_open(ctch))
|
|
return;
|
|
|
|
do {
|
|
err = ctb_read(ctb, msg);
|
|
if (err)
|
|
break;
|
|
|
|
if (ct_header_is_response(msg[0]))
|
|
err = ct_handle_response(ct, msg);
|
|
else
|
|
err = ct_handle_request(ct, msg);
|
|
} while (!err);
|
|
|
|
if (GEM_WARN_ON(err == -EPROTO)) {
|
|
DRM_ERROR("CT: corrupted message detected!\n");
|
|
ctb->desc->is_in_error = 1;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* When we're communicating with the GuC over CT, GuC uses events
|
|
* to notify us about new messages being posted on the RECV buffer.
|
|
*/
|
|
static void intel_guc_to_host_event_handler_ct(struct intel_guc *guc)
|
|
{
|
|
struct intel_guc_ct *ct = &guc->ct;
|
|
|
|
ct_process_host_channel(ct);
|
|
}
|
|
|
|
/**
|
|
* intel_guc_ct_enable - Enable buffer based command transport.
|
|
* @ct: pointer to CT struct
|
|
*
|
|
* Shall only be called for platforms with HAS_GUC_CT.
|
|
*
|
|
* Return: 0 on success, a negative errno code on failure.
|
|
*/
|
|
int intel_guc_ct_enable(struct intel_guc_ct *ct)
|
|
{
|
|
struct intel_guc *guc = ct_to_guc(ct);
|
|
struct drm_i915_private *i915 = guc_to_i915(guc);
|
|
struct intel_guc_ct_channel *ctch = &ct->host_channel;
|
|
int err;
|
|
|
|
GEM_BUG_ON(!HAS_GUC_CT(i915));
|
|
|
|
err = ctch_open(guc, ctch);
|
|
if (unlikely(err))
|
|
return err;
|
|
|
|
/* Switch into cmd transport buffer based send() */
|
|
guc->send = intel_guc_send_ct;
|
|
guc->handler = intel_guc_to_host_event_handler_ct;
|
|
DRM_INFO("CT: %s\n", enableddisabled(true));
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* intel_guc_ct_disable - Disable buffer based command transport.
|
|
* @ct: pointer to CT struct
|
|
*
|
|
* Shall only be called for platforms with HAS_GUC_CT.
|
|
*/
|
|
void intel_guc_ct_disable(struct intel_guc_ct *ct)
|
|
{
|
|
struct intel_guc *guc = ct_to_guc(ct);
|
|
struct drm_i915_private *i915 = guc_to_i915(guc);
|
|
struct intel_guc_ct_channel *ctch = &ct->host_channel;
|
|
|
|
GEM_BUG_ON(!HAS_GUC_CT(i915));
|
|
|
|
if (!ctch_is_open(ctch))
|
|
return;
|
|
|
|
ctch_close(guc, ctch);
|
|
|
|
/* Disable send */
|
|
guc->send = intel_guc_send_nop;
|
|
guc->handler = intel_guc_to_host_event_handler_nop;
|
|
DRM_INFO("CT: %s\n", enableddisabled(false));
|
|
}
|