| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Copyright 2020 Linaro Limited |
| * |
| * Author: Daniel Lezcano <daniel.lezcano@linaro.org> |
| * |
| * Generic netlink for thermal management framework |
| */ |
| #include <linux/module.h> |
| #include <linux/notifier.h> |
| #include <linux/kernel.h> |
| #include <net/genetlink.h> |
| #include <uapi/linux/thermal.h> |
| |
| #include "thermal_core.h" |
| |
| static const struct genl_multicast_group thermal_genl_mcgrps[] = { |
| [THERMAL_GENL_SAMPLING_GROUP] = { .name = THERMAL_GENL_SAMPLING_GROUP_NAME, }, |
| [THERMAL_GENL_EVENT_GROUP] = { .name = THERMAL_GENL_EVENT_GROUP_NAME, }, |
| }; |
| |
| static const struct nla_policy thermal_genl_policy[THERMAL_GENL_ATTR_MAX + 1] = { |
| /* Thermal zone */ |
| [THERMAL_GENL_ATTR_TZ] = { .type = NLA_NESTED }, |
| [THERMAL_GENL_ATTR_TZ_ID] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_TZ_TEMP] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_TZ_TRIP] = { .type = NLA_NESTED }, |
| [THERMAL_GENL_ATTR_TZ_TRIP_ID] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_TZ_TRIP_TEMP] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_TZ_TRIP_TYPE] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_TZ_TRIP_HYST] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_TZ_MODE] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_TZ_CDEV_WEIGHT] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_TZ_NAME] = { .type = NLA_STRING, |
| .len = THERMAL_NAME_LENGTH }, |
| /* Governor(s) */ |
| [THERMAL_GENL_ATTR_TZ_GOV] = { .type = NLA_NESTED }, |
| [THERMAL_GENL_ATTR_TZ_GOV_NAME] = { .type = NLA_STRING, |
| .len = THERMAL_NAME_LENGTH }, |
| /* Cooling devices */ |
| [THERMAL_GENL_ATTR_CDEV] = { .type = NLA_NESTED }, |
| [THERMAL_GENL_ATTR_CDEV_ID] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_CDEV_CUR_STATE] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_CDEV_MAX_STATE] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_CDEV_NAME] = { .type = NLA_STRING, |
| .len = THERMAL_NAME_LENGTH }, |
| /* CPU capabilities */ |
| [THERMAL_GENL_ATTR_CPU_CAPABILITY] = { .type = NLA_NESTED }, |
| [THERMAL_GENL_ATTR_CPU_CAPABILITY_ID] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_CPU_CAPABILITY_PERFORMANCE] = { .type = NLA_U32 }, |
| [THERMAL_GENL_ATTR_CPU_CAPABILITY_EFFICIENCY] = { .type = NLA_U32 }, |
| }; |
| |
| struct param { |
| struct nlattr **attrs; |
| struct sk_buff *msg; |
| const char *name; |
| int tz_id; |
| int cdev_id; |
| int trip_id; |
| int trip_temp; |
| int trip_type; |
| int trip_hyst; |
| int temp; |
| int cdev_state; |
| int cdev_max_state; |
| struct thermal_genl_cpu_caps *cpu_capabilities; |
| int cpu_capabilities_count; |
| }; |
| |
| typedef int (*cb_t)(struct param *); |
| |
| static struct genl_family thermal_genl_family; |
| static BLOCKING_NOTIFIER_HEAD(thermal_genl_chain); |
| |
| static int thermal_group_has_listeners(enum thermal_genl_multicast_groups group) |
| { |
| return genl_has_listeners(&thermal_genl_family, &init_net, group); |
| } |
| |
| /************************** Sampling encoding *******************************/ |
| |
| int thermal_genl_sampling_temp(int id, int temp) |
| { |
| struct sk_buff *skb; |
| void *hdr; |
| |
| if (!thermal_group_has_listeners(THERMAL_GENL_SAMPLING_GROUP)) |
| return 0; |
| |
| skb = genlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL); |
| if (!skb) |
| return -ENOMEM; |
| |
| hdr = genlmsg_put(skb, 0, 0, &thermal_genl_family, 0, |
| THERMAL_GENL_SAMPLING_TEMP); |
| if (!hdr) |
| goto out_free; |
| |
| if (nla_put_u32(skb, THERMAL_GENL_ATTR_TZ_ID, id)) |
| goto out_cancel; |
| |
| if (nla_put_u32(skb, THERMAL_GENL_ATTR_TZ_TEMP, temp)) |
| goto out_cancel; |
| |
| genlmsg_end(skb, hdr); |
| |
| genlmsg_multicast(&thermal_genl_family, skb, 0, THERMAL_GENL_SAMPLING_GROUP, GFP_KERNEL); |
| |
| return 0; |
| out_cancel: |
| genlmsg_cancel(skb, hdr); |
| out_free: |
| nlmsg_free(skb); |
| |
| return -EMSGSIZE; |
| } |
| |
| /**************************** Event encoding *********************************/ |
| |
| static int thermal_genl_event_tz_create(struct param *p) |
| { |
| if (nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_ID, p->tz_id) || |
| nla_put_string(p->msg, THERMAL_GENL_ATTR_TZ_NAME, p->name)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_event_tz(struct param *p) |
| { |
| if (nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_ID, p->tz_id)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_event_tz_trip_up(struct param *p) |
| { |
| if (nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_ID, p->tz_id) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_TRIP_ID, p->trip_id) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_TEMP, p->temp)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_event_tz_trip_change(struct param *p) |
| { |
| if (nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_ID, p->tz_id) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_TRIP_ID, p->trip_id) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_TRIP_TYPE, p->trip_type) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_TRIP_TEMP, p->trip_temp) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_TRIP_HYST, p->trip_hyst)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_event_cdev_add(struct param *p) |
| { |
| if (nla_put_string(p->msg, THERMAL_GENL_ATTR_CDEV_NAME, |
| p->name) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_CDEV_ID, |
| p->cdev_id) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_CDEV_MAX_STATE, |
| p->cdev_max_state)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_event_cdev_delete(struct param *p) |
| { |
| if (nla_put_u32(p->msg, THERMAL_GENL_ATTR_CDEV_ID, p->cdev_id)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_event_cdev_state_update(struct param *p) |
| { |
| if (nla_put_u32(p->msg, THERMAL_GENL_ATTR_CDEV_ID, |
| p->cdev_id) || |
| nla_put_u32(p->msg, THERMAL_GENL_ATTR_CDEV_CUR_STATE, |
| p->cdev_state)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_event_gov_change(struct param *p) |
| { |
| if (nla_put_u32(p->msg, THERMAL_GENL_ATTR_TZ_ID, p->tz_id) || |
| nla_put_string(p->msg, THERMAL_GENL_ATTR_GOV_NAME, p->name)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_event_cpu_capability_change(struct param *p) |
| { |
| struct thermal_genl_cpu_caps *cpu_cap = p->cpu_capabilities; |
| struct sk_buff *msg = p->msg; |
| struct nlattr *start_cap; |
| int i; |
| |
| start_cap = nla_nest_start(msg, THERMAL_GENL_ATTR_CPU_CAPABILITY); |
| if (!start_cap) |
| return -EMSGSIZE; |
| |
| for (i = 0; i < p->cpu_capabilities_count; ++i) { |
| if (nla_put_u32(msg, THERMAL_GENL_ATTR_CPU_CAPABILITY_ID, |
| cpu_cap->cpu)) |
| goto out_cancel_nest; |
| |
| if (nla_put_u32(msg, THERMAL_GENL_ATTR_CPU_CAPABILITY_PERFORMANCE, |
| cpu_cap->performance)) |
| goto out_cancel_nest; |
| |
| if (nla_put_u32(msg, THERMAL_GENL_ATTR_CPU_CAPABILITY_EFFICIENCY, |
| cpu_cap->efficiency)) |
| goto out_cancel_nest; |
| |
| ++cpu_cap; |
| } |
| |
| nla_nest_end(msg, start_cap); |
| |
| return 0; |
| out_cancel_nest: |
| nla_nest_cancel(msg, start_cap); |
| |
| return -EMSGSIZE; |
| } |
| |
| int thermal_genl_event_tz_delete(struct param *p) |
| __attribute__((alias("thermal_genl_event_tz"))); |
| |
| int thermal_genl_event_tz_enable(struct param *p) |
| __attribute__((alias("thermal_genl_event_tz"))); |
| |
| int thermal_genl_event_tz_disable(struct param *p) |
| __attribute__((alias("thermal_genl_event_tz"))); |
| |
| int thermal_genl_event_tz_trip_down(struct param *p) |
| __attribute__((alias("thermal_genl_event_tz_trip_up"))); |
| |
| static cb_t event_cb[] = { |
| [THERMAL_GENL_EVENT_TZ_CREATE] = thermal_genl_event_tz_create, |
| [THERMAL_GENL_EVENT_TZ_DELETE] = thermal_genl_event_tz_delete, |
| [THERMAL_GENL_EVENT_TZ_ENABLE] = thermal_genl_event_tz_enable, |
| [THERMAL_GENL_EVENT_TZ_DISABLE] = thermal_genl_event_tz_disable, |
| [THERMAL_GENL_EVENT_TZ_TRIP_UP] = thermal_genl_event_tz_trip_up, |
| [THERMAL_GENL_EVENT_TZ_TRIP_DOWN] = thermal_genl_event_tz_trip_down, |
| [THERMAL_GENL_EVENT_TZ_TRIP_CHANGE] = thermal_genl_event_tz_trip_change, |
| [THERMAL_GENL_EVENT_CDEV_ADD] = thermal_genl_event_cdev_add, |
| [THERMAL_GENL_EVENT_CDEV_DELETE] = thermal_genl_event_cdev_delete, |
| [THERMAL_GENL_EVENT_CDEV_STATE_UPDATE] = thermal_genl_event_cdev_state_update, |
| [THERMAL_GENL_EVENT_TZ_GOV_CHANGE] = thermal_genl_event_gov_change, |
| [THERMAL_GENL_EVENT_CPU_CAPABILITY_CHANGE] = thermal_genl_event_cpu_capability_change, |
| }; |
| |
| /* |
| * Generic netlink event encoding |
| */ |
| static int thermal_genl_send_event(enum thermal_genl_event event, |
| struct param *p) |
| { |
| struct sk_buff *msg; |
| int ret = -EMSGSIZE; |
| void *hdr; |
| |
| if (!thermal_group_has_listeners(THERMAL_GENL_EVENT_GROUP)) |
| return 0; |
| |
| msg = genlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL); |
| if (!msg) |
| return -ENOMEM; |
| p->msg = msg; |
| |
| hdr = genlmsg_put(msg, 0, 0, &thermal_genl_family, 0, event); |
| if (!hdr) |
| goto out_free_msg; |
| |
| ret = event_cb[event](p); |
| if (ret) |
| goto out_cancel_msg; |
| |
| genlmsg_end(msg, hdr); |
| |
| genlmsg_multicast(&thermal_genl_family, msg, 0, THERMAL_GENL_EVENT_GROUP, GFP_KERNEL); |
| |
| return 0; |
| |
| out_cancel_msg: |
| genlmsg_cancel(msg, hdr); |
| out_free_msg: |
| nlmsg_free(msg); |
| |
| return ret; |
| } |
| |
| int thermal_notify_tz_create(const struct thermal_zone_device *tz) |
| { |
| struct param p = { .tz_id = tz->id, .name = tz->type }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_TZ_CREATE, &p); |
| } |
| |
| int thermal_notify_tz_delete(const struct thermal_zone_device *tz) |
| { |
| struct param p = { .tz_id = tz->id }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_TZ_DELETE, &p); |
| } |
| |
| int thermal_notify_tz_enable(const struct thermal_zone_device *tz) |
| { |
| struct param p = { .tz_id = tz->id }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_TZ_ENABLE, &p); |
| } |
| |
| int thermal_notify_tz_disable(const struct thermal_zone_device *tz) |
| { |
| struct param p = { .tz_id = tz->id }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_TZ_DISABLE, &p); |
| } |
| |
| int thermal_notify_tz_trip_down(const struct thermal_zone_device *tz, |
| const struct thermal_trip *trip) |
| { |
| struct param p = { .tz_id = tz->id, |
| .trip_id = thermal_zone_trip_id(tz, trip), |
| .temp = tz->temperature }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_TZ_TRIP_DOWN, &p); |
| } |
| |
| int thermal_notify_tz_trip_up(const struct thermal_zone_device *tz, |
| const struct thermal_trip *trip) |
| { |
| struct param p = { .tz_id = tz->id, |
| .trip_id = thermal_zone_trip_id(tz, trip), |
| .temp = tz->temperature }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_TZ_TRIP_UP, &p); |
| } |
| |
| int thermal_notify_tz_trip_change(const struct thermal_zone_device *tz, |
| const struct thermal_trip *trip) |
| { |
| struct param p = { .tz_id = tz->id, |
| .trip_id = thermal_zone_trip_id(tz, trip), |
| .trip_type = trip->type, |
| .trip_temp = trip->temperature, |
| .trip_hyst = trip->hysteresis }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_TZ_TRIP_CHANGE, &p); |
| } |
| |
| int thermal_notify_cdev_state_update(const struct thermal_cooling_device *cdev, |
| int state) |
| { |
| struct param p = { .cdev_id = cdev->id, .cdev_state = state }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_CDEV_STATE_UPDATE, &p); |
| } |
| |
| int thermal_notify_cdev_add(const struct thermal_cooling_device *cdev) |
| { |
| struct param p = { .cdev_id = cdev->id, .name = cdev->type, |
| .cdev_max_state = cdev->max_state }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_CDEV_ADD, &p); |
| } |
| |
| int thermal_notify_cdev_delete(const struct thermal_cooling_device *cdev) |
| { |
| struct param p = { .cdev_id = cdev->id }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_CDEV_DELETE, &p); |
| } |
| |
| int thermal_notify_tz_gov_change(const struct thermal_zone_device *tz, |
| const char *name) |
| { |
| struct param p = { .tz_id = tz->id, .name = name }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_TZ_GOV_CHANGE, &p); |
| } |
| |
| int thermal_genl_cpu_capability_event(int count, |
| struct thermal_genl_cpu_caps *caps) |
| { |
| struct param p = { .cpu_capabilities_count = count, .cpu_capabilities = caps }; |
| |
| return thermal_genl_send_event(THERMAL_GENL_EVENT_CPU_CAPABILITY_CHANGE, &p); |
| } |
| EXPORT_SYMBOL_GPL(thermal_genl_cpu_capability_event); |
| |
| /*************************** Command encoding ********************************/ |
| |
| static int __thermal_genl_cmd_tz_get_id(struct thermal_zone_device *tz, |
| void *data) |
| { |
| struct sk_buff *msg = data; |
| |
| if (nla_put_u32(msg, THERMAL_GENL_ATTR_TZ_ID, tz->id) || |
| nla_put_string(msg, THERMAL_GENL_ATTR_TZ_NAME, tz->type)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_cmd_tz_get_id(struct param *p) |
| { |
| struct sk_buff *msg = p->msg; |
| struct nlattr *start_tz; |
| int ret; |
| |
| start_tz = nla_nest_start(msg, THERMAL_GENL_ATTR_TZ); |
| if (!start_tz) |
| return -EMSGSIZE; |
| |
| ret = for_each_thermal_zone(__thermal_genl_cmd_tz_get_id, msg); |
| if (ret) |
| goto out_cancel_nest; |
| |
| nla_nest_end(msg, start_tz); |
| |
| return 0; |
| |
| out_cancel_nest: |
| nla_nest_cancel(msg, start_tz); |
| |
| return ret; |
| } |
| |
| static int thermal_genl_cmd_tz_get_trip(struct param *p) |
| { |
| struct sk_buff *msg = p->msg; |
| const struct thermal_trip_desc *td; |
| struct nlattr *start_trip; |
| int id; |
| |
| if (!p->attrs[THERMAL_GENL_ATTR_TZ_ID]) |
| return -EINVAL; |
| |
| id = nla_get_u32(p->attrs[THERMAL_GENL_ATTR_TZ_ID]); |
| |
| CLASS(thermal_zone_get_by_id, tz)(id); |
| if (!tz) |
| return -EINVAL; |
| |
| start_trip = nla_nest_start(msg, THERMAL_GENL_ATTR_TZ_TRIP); |
| if (!start_trip) |
| return -EMSGSIZE; |
| |
| mutex_lock(&tz->lock); |
| |
| for_each_trip_desc(tz, td) { |
| const struct thermal_trip *trip = &td->trip; |
| |
| if (nla_put_u32(msg, THERMAL_GENL_ATTR_TZ_TRIP_ID, |
| thermal_zone_trip_id(tz, trip)) || |
| nla_put_u32(msg, THERMAL_GENL_ATTR_TZ_TRIP_TYPE, trip->type) || |
| nla_put_u32(msg, THERMAL_GENL_ATTR_TZ_TRIP_TEMP, trip->temperature) || |
| nla_put_u32(msg, THERMAL_GENL_ATTR_TZ_TRIP_HYST, trip->hysteresis)) |
| goto out_cancel_nest; |
| } |
| |
| mutex_unlock(&tz->lock); |
| |
| nla_nest_end(msg, start_trip); |
| |
| return 0; |
| |
| out_cancel_nest: |
| mutex_unlock(&tz->lock); |
| |
| return -EMSGSIZE; |
| } |
| |
| static int thermal_genl_cmd_tz_get_temp(struct param *p) |
| { |
| struct sk_buff *msg = p->msg; |
| int temp, ret, id; |
| |
| if (!p->attrs[THERMAL_GENL_ATTR_TZ_ID]) |
| return -EINVAL; |
| |
| id = nla_get_u32(p->attrs[THERMAL_GENL_ATTR_TZ_ID]); |
| |
| CLASS(thermal_zone_get_by_id, tz)(id); |
| if (!tz) |
| return -EINVAL; |
| |
| ret = thermal_zone_get_temp(tz, &temp); |
| if (ret) |
| return ret; |
| |
| if (nla_put_u32(msg, THERMAL_GENL_ATTR_TZ_ID, id) || |
| nla_put_u32(msg, THERMAL_GENL_ATTR_TZ_TEMP, temp)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_cmd_tz_get_gov(struct param *p) |
| { |
| struct sk_buff *msg = p->msg; |
| int id, ret = 0; |
| |
| if (!p->attrs[THERMAL_GENL_ATTR_TZ_ID]) |
| return -EINVAL; |
| |
| id = nla_get_u32(p->attrs[THERMAL_GENL_ATTR_TZ_ID]); |
| |
| CLASS(thermal_zone_get_by_id, tz)(id); |
| if (!tz) |
| return -EINVAL; |
| |
| mutex_lock(&tz->lock); |
| |
| if (nla_put_u32(msg, THERMAL_GENL_ATTR_TZ_ID, id) || |
| nla_put_string(msg, THERMAL_GENL_ATTR_TZ_GOV_NAME, |
| tz->governor->name)) |
| ret = -EMSGSIZE; |
| |
| mutex_unlock(&tz->lock); |
| |
| return ret; |
| } |
| |
| static int __thermal_genl_cmd_cdev_get(struct thermal_cooling_device *cdev, |
| void *data) |
| { |
| struct sk_buff *msg = data; |
| |
| if (nla_put_u32(msg, THERMAL_GENL_ATTR_CDEV_ID, cdev->id)) |
| return -EMSGSIZE; |
| |
| if (nla_put_string(msg, THERMAL_GENL_ATTR_CDEV_NAME, cdev->type)) |
| return -EMSGSIZE; |
| |
| return 0; |
| } |
| |
| static int thermal_genl_cmd_cdev_get(struct param *p) |
| { |
| struct sk_buff *msg = p->msg; |
| struct nlattr *start_cdev; |
| int ret; |
| |
| start_cdev = nla_nest_start(msg, THERMAL_GENL_ATTR_CDEV); |
| if (!start_cdev) |
| return -EMSGSIZE; |
| |
| ret = for_each_thermal_cooling_device(__thermal_genl_cmd_cdev_get, msg); |
| if (ret) |
| goto out_cancel_nest; |
| |
| nla_nest_end(msg, start_cdev); |
| |
| return 0; |
| out_cancel_nest: |
| nla_nest_cancel(msg, start_cdev); |
| |
| return ret; |
| } |
| |
| static cb_t cmd_cb[] = { |
| [THERMAL_GENL_CMD_TZ_GET_ID] = thermal_genl_cmd_tz_get_id, |
| [THERMAL_GENL_CMD_TZ_GET_TRIP] = thermal_genl_cmd_tz_get_trip, |
| [THERMAL_GENL_CMD_TZ_GET_TEMP] = thermal_genl_cmd_tz_get_temp, |
| [THERMAL_GENL_CMD_TZ_GET_GOV] = thermal_genl_cmd_tz_get_gov, |
| [THERMAL_GENL_CMD_CDEV_GET] = thermal_genl_cmd_cdev_get, |
| }; |
| |
| static int thermal_genl_cmd_dumpit(struct sk_buff *skb, |
| struct netlink_callback *cb) |
| { |
| struct param p = { .msg = skb }; |
| const struct genl_dumpit_info *info = genl_dumpit_info(cb); |
| int cmd = info->op.cmd; |
| int ret; |
| void *hdr; |
| |
| hdr = genlmsg_put(skb, 0, 0, &thermal_genl_family, 0, cmd); |
| if (!hdr) |
| return -EMSGSIZE; |
| |
| ret = cmd_cb[cmd](&p); |
| if (ret) |
| goto out_cancel_msg; |
| |
| genlmsg_end(skb, hdr); |
| |
| return 0; |
| |
| out_cancel_msg: |
| genlmsg_cancel(skb, hdr); |
| |
| return ret; |
| } |
| |
| static int thermal_genl_cmd_doit(struct sk_buff *skb, |
| struct genl_info *info) |
| { |
| struct param p = { .attrs = info->attrs }; |
| struct sk_buff *msg; |
| void *hdr; |
| int cmd = info->genlhdr->cmd; |
| int ret = -EMSGSIZE; |
| |
| msg = genlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL); |
| if (!msg) |
| return -ENOMEM; |
| p.msg = msg; |
| |
| hdr = genlmsg_put_reply(msg, info, &thermal_genl_family, 0, cmd); |
| if (!hdr) |
| goto out_free_msg; |
| |
| ret = cmd_cb[cmd](&p); |
| if (ret) |
| goto out_cancel_msg; |
| |
| genlmsg_end(msg, hdr); |
| |
| return genlmsg_reply(msg, info); |
| |
| out_cancel_msg: |
| genlmsg_cancel(msg, hdr); |
| out_free_msg: |
| nlmsg_free(msg); |
| |
| return ret; |
| } |
| |
| static int thermal_genl_bind(int mcgrp) |
| { |
| struct thermal_genl_notify n = { .mcgrp = mcgrp }; |
| |
| if (WARN_ON_ONCE(mcgrp > THERMAL_GENL_MAX_GROUP)) |
| return -EINVAL; |
| |
| blocking_notifier_call_chain(&thermal_genl_chain, THERMAL_NOTIFY_BIND, &n); |
| return 0; |
| } |
| |
| static void thermal_genl_unbind(int mcgrp) |
| { |
| struct thermal_genl_notify n = { .mcgrp = mcgrp }; |
| |
| if (WARN_ON_ONCE(mcgrp > THERMAL_GENL_MAX_GROUP)) |
| return; |
| |
| blocking_notifier_call_chain(&thermal_genl_chain, THERMAL_NOTIFY_UNBIND, &n); |
| } |
| |
| static const struct genl_small_ops thermal_genl_ops[] = { |
| { |
| .cmd = THERMAL_GENL_CMD_TZ_GET_ID, |
| .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, |
| .dumpit = thermal_genl_cmd_dumpit, |
| }, |
| { |
| .cmd = THERMAL_GENL_CMD_TZ_GET_TRIP, |
| .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, |
| .doit = thermal_genl_cmd_doit, |
| }, |
| { |
| .cmd = THERMAL_GENL_CMD_TZ_GET_TEMP, |
| .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, |
| .doit = thermal_genl_cmd_doit, |
| }, |
| { |
| .cmd = THERMAL_GENL_CMD_TZ_GET_GOV, |
| .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, |
| .doit = thermal_genl_cmd_doit, |
| }, |
| { |
| .cmd = THERMAL_GENL_CMD_CDEV_GET, |
| .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, |
| .dumpit = thermal_genl_cmd_dumpit, |
| }, |
| }; |
| |
| static struct genl_family thermal_genl_family __ro_after_init = { |
| .hdrsize = 0, |
| .name = THERMAL_GENL_FAMILY_NAME, |
| .version = THERMAL_GENL_VERSION, |
| .maxattr = THERMAL_GENL_ATTR_MAX, |
| .policy = thermal_genl_policy, |
| .bind = thermal_genl_bind, |
| .unbind = thermal_genl_unbind, |
| .small_ops = thermal_genl_ops, |
| .n_small_ops = ARRAY_SIZE(thermal_genl_ops), |
| .resv_start_op = THERMAL_GENL_CMD_CDEV_GET + 1, |
| .mcgrps = thermal_genl_mcgrps, |
| .n_mcgrps = ARRAY_SIZE(thermal_genl_mcgrps), |
| }; |
| |
| int thermal_genl_register_notifier(struct notifier_block *nb) |
| { |
| return blocking_notifier_chain_register(&thermal_genl_chain, nb); |
| } |
| |
| int thermal_genl_unregister_notifier(struct notifier_block *nb) |
| { |
| return blocking_notifier_chain_unregister(&thermal_genl_chain, nb); |
| } |
| |
| int __init thermal_netlink_init(void) |
| { |
| return genl_register_family(&thermal_genl_family); |
| } |
| |
| void __init thermal_netlink_exit(void) |
| { |
| genl_unregister_family(&thermal_genl_family); |
| } |