mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-06 02:24:14 +08:00
platform/x86: ISST: Add IOCTL to Translate Linux logical CPU to PUNIT CPU number
Add processing for IOCTL command ISST_IF_GET_PHY_ID. This converts from the Linux logical CPU to PUNIT CPU numbering scheme. Signed-off-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com> Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
This commit is contained in:
parent
8fbfb6fc67
commit
fb5b36a413
@ -134,16 +134,90 @@ static void isst_if_cpu_info_exit(void)
|
||||
kfree(isst_cpu_info);
|
||||
};
|
||||
|
||||
static long isst_if_proc_phyid_req(u8 *cmd_ptr, int *write_only, int resume)
|
||||
{
|
||||
struct isst_if_cpu_map *cpu_map;
|
||||
|
||||
cpu_map = (struct isst_if_cpu_map *)cmd_ptr;
|
||||
if (cpu_map->logical_cpu >= nr_cpu_ids ||
|
||||
cpu_map->logical_cpu >= num_possible_cpus())
|
||||
return -EINVAL;
|
||||
|
||||
*write_only = 0;
|
||||
cpu_map->physical_cpu = isst_cpu_info[cpu_map->logical_cpu].punit_cpu_id;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static long isst_if_exec_multi_cmd(void __user *argp, struct isst_if_cmd_cb *cb)
|
||||
{
|
||||
unsigned char __user *ptr;
|
||||
u32 cmd_count;
|
||||
u8 *cmd_ptr;
|
||||
long ret;
|
||||
int i;
|
||||
|
||||
/* Each multi command has u32 command count as the first field */
|
||||
if (copy_from_user(&cmd_count, argp, sizeof(cmd_count)))
|
||||
return -EFAULT;
|
||||
|
||||
if (!cmd_count || cmd_count > ISST_IF_CMD_LIMIT)
|
||||
return -EINVAL;
|
||||
|
||||
cmd_ptr = kmalloc(cb->cmd_size, GFP_KERNEL);
|
||||
if (!cmd_ptr)
|
||||
return -ENOMEM;
|
||||
|
||||
/* cb->offset points to start of the command after the command count */
|
||||
ptr = argp + cb->offset;
|
||||
|
||||
for (i = 0; i < cmd_count; ++i) {
|
||||
int wr_only;
|
||||
|
||||
if (signal_pending(current)) {
|
||||
ret = -EINTR;
|
||||
break;
|
||||
}
|
||||
|
||||
if (copy_from_user(cmd_ptr, ptr, cb->cmd_size)) {
|
||||
ret = -EFAULT;
|
||||
break;
|
||||
}
|
||||
|
||||
ret = cb->cmd_callback(cmd_ptr, &wr_only, 0);
|
||||
if (ret)
|
||||
break;
|
||||
|
||||
if (!wr_only && copy_to_user(ptr, cmd_ptr, cb->cmd_size)) {
|
||||
ret = -EFAULT;
|
||||
break;
|
||||
}
|
||||
|
||||
ptr += cb->cmd_size;
|
||||
}
|
||||
|
||||
kfree(cmd_ptr);
|
||||
|
||||
return i ? i : ret;
|
||||
}
|
||||
|
||||
static long isst_if_def_ioctl(struct file *file, unsigned int cmd,
|
||||
unsigned long arg)
|
||||
{
|
||||
void __user *argp = (void __user *)arg;
|
||||
struct isst_if_cmd_cb cmd_cb;
|
||||
long ret = -ENOTTY;
|
||||
|
||||
switch (cmd) {
|
||||
case ISST_IF_GET_PLATFORM_INFO:
|
||||
ret = isst_if_get_platform_info(argp);
|
||||
break;
|
||||
case ISST_IF_GET_PHY_ID:
|
||||
cmd_cb.cmd_size = sizeof(struct isst_if_cpu_map);
|
||||
cmd_cb.offset = offsetof(struct isst_if_cpu_maps, cpu_map);
|
||||
cmd_cb.cmd_callback = isst_if_proc_phyid_req;
|
||||
ret = isst_if_exec_multi_cmd(argp, &cmd_cb);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
@ -36,6 +36,34 @@ struct isst_if_platform_info {
|
||||
__u8 mmio_supported;
|
||||
};
|
||||
|
||||
/**
|
||||
* struct isst_if_cpu_map - CPU mapping between logical and physical CPU
|
||||
* @logical_cpu: Linux logical CPU number
|
||||
* @physical_cpu: PUNIT CPU number
|
||||
*
|
||||
* Used to convert from Linux logical CPU to PUNIT CPU numbering scheme.
|
||||
* The PUNIT CPU number is different than APIC ID based CPU numbering.
|
||||
*/
|
||||
struct isst_if_cpu_map {
|
||||
__u32 logical_cpu;
|
||||
__u32 physical_cpu;
|
||||
};
|
||||
|
||||
/**
|
||||
* struct isst_if_cpu_maps - structure for CPU map IOCTL
|
||||
* @cmd_count: Number of CPU mapping command in cpu_map[]
|
||||
* @cpu_map[]: Holds one or more CPU map data structure
|
||||
*
|
||||
* This structure used with ioctl ISST_IF_GET_PHY_ID to send
|
||||
* one or more CPU mapping commands. Here IOCTL return value indicates
|
||||
* number of commands sent or error number if no commands have been sent.
|
||||
*/
|
||||
struct isst_if_cpu_maps {
|
||||
__u32 cmd_count;
|
||||
struct isst_if_cpu_map cpu_map[1];
|
||||
};
|
||||
|
||||
#define ISST_IF_MAGIC 0xFE
|
||||
#define ISST_IF_GET_PLATFORM_INFO _IOR(ISST_IF_MAGIC, 0, struct isst_if_platform_info *)
|
||||
#define ISST_IF_GET_PHY_ID _IOWR(ISST_IF_MAGIC, 1, struct isst_if_cpu_map *)
|
||||
#endif
|
||||
|
Loading…
Reference in New Issue
Block a user