blob: efafdc3101d3a446a935f9d4a5f5eacc1370c6d5 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
|
/* SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0)
*
* Copyright 2013-2015 Freescale Semiconductor Inc.
* Copyright 2017 NXP
*
*/
#include <fsl_mc_sys.h>
#include <fsl_mc_cmd.h>
#include <rte_spinlock.h>
/** User space framework uses MC Portal in shared mode. Following change
* introduces lock in MC FLIB
*/
/**
* A static spinlock initializer.
*/
static rte_spinlock_t mc_portal_lock = RTE_SPINLOCK_INITIALIZER;
static int mc_status_to_error(enum mc_cmd_status status)
{
switch (status) {
case MC_CMD_STATUS_OK:
return 0;
case MC_CMD_STATUS_AUTH_ERR:
return -EACCES; /* Token error */
case MC_CMD_STATUS_NO_PRIVILEGE:
return -EPERM; /* Permission denied */
case MC_CMD_STATUS_DMA_ERR:
return -EIO; /* Input/Output error */
case MC_CMD_STATUS_CONFIG_ERR:
return -EINVAL; /* Device not configured */
case MC_CMD_STATUS_TIMEOUT:
return -ETIMEDOUT; /* Operation timed out */
case MC_CMD_STATUS_NO_RESOURCE:
return -ENAVAIL; /* Resource temporarily unavailable */
case MC_CMD_STATUS_NO_MEMORY:
return -ENOMEM; /* Cannot allocate memory */
case MC_CMD_STATUS_BUSY:
return -EBUSY; /* Device busy */
case MC_CMD_STATUS_UNSUPPORTED_OP:
return -ENOTSUP; /* Operation not supported by device */
case MC_CMD_STATUS_INVALID_STATE:
return -ENODEV; /* Invalid device state */
default:
break;
}
/* Not expected to reach here */
return -EINVAL;
}
int mc_send_command(struct fsl_mc_io *mc_io, struct mc_command *cmd)
{
enum mc_cmd_status status;
uint64_t response;
if (!mc_io || !mc_io->regs)
return -EACCES;
/* --- Call lock function here in case portal is shared --- */
rte_spinlock_lock(&mc_portal_lock);
mc_write_command(mc_io->regs, cmd);
/* Spin until status changes */
do {
response = ioread64(mc_io->regs);
status = mc_cmd_read_status((struct mc_command *)&response);
/* --- Call wait function here to prevent blocking ---
* Change the loop condition accordingly to exit on timeout.
*/
} while (status == MC_CMD_STATUS_READY);
/* Read the response back into the command buffer */
mc_read_response(mc_io->regs, cmd);
/* --- Call unlock function here in case portal is shared --- */
rte_spinlock_unlock(&mc_portal_lock);
return mc_status_to_error(status);
}
|