diff options
author | Dominik Sliwa <dominik.sliwa@toradex.com> | 2019-03-04 12:01:54 +0100 |
---|---|---|
committer | Dominik Sliwa <dominik.sliwa@toradex.com> | 2019-03-04 12:01:54 +0100 |
commit | 348fa3f6871f56a37dcd16c99ca98118c6d79a38 (patch) | |
tree | 6fcae7785bae4ffb838fd6549f7d01ba6abf0763 /compat/backport-4.3.c |
Backports v4.19.24
Backports generated by toradex backports 515a1fa55cda2b1d952872e1786857481bd54fcc
against mainline kernel tag v4.19.24
Signed-off-by: Dominik Sliwa <dominik.sliwa@toradex.com>
Diffstat (limited to 'compat/backport-4.3.c')
-rw-r--r-- | compat/backport-4.3.c | 304 |
1 files changed, 304 insertions, 0 deletions
diff --git a/compat/backport-4.3.c b/compat/backport-4.3.c new file mode 100644 index 0000000..04698ad --- /dev/null +++ b/compat/backport-4.3.c @@ -0,0 +1,304 @@ +/* + * Copyright (c) 2015 Hauke Mehrtens <hauke@hauke-m.de> + * Copyright (c) 2015 - 2016 Intel Deutschland GmbH + * + * Backport functionality introduced in Linux 4.3. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#include <linux/version.h> +#include <linux/seq_file.h> +#include <linux/export.h> +#include <linux/printk.h> +#include <linux/thermal.h> +#include <linux/slab.h> +#include <linux/property.h> +#include <linux/etherdevice.h> +#include <linux/of.h> + +#ifdef CONFIG_THERMAL +#if LINUX_VERSION_IS_GEQ(3,8,0) +struct backport_thermal_ops_wrapper { + old_thermal_zone_device_ops_t ops; + struct thermal_zone_device_ops *driver_ops; +}; + +static int backport_thermal_get_temp(struct thermal_zone_device *dev, + unsigned long *temp) +{ + struct backport_thermal_ops_wrapper *wrapper = + container_of(dev->ops, struct backport_thermal_ops_wrapper, ops); + int _temp, ret; + + ret = wrapper->driver_ops->get_temp(dev, &_temp); + if (!ret) + *temp = (unsigned long)_temp; + + return ret; +} + +static int backport_thermal_get_trip_temp(struct thermal_zone_device *dev, + int i, unsigned long *temp) +{ + struct backport_thermal_ops_wrapper *wrapper = + container_of(dev->ops, struct backport_thermal_ops_wrapper, ops); + int _temp, ret; + + ret = wrapper->driver_ops->get_trip_temp(dev, i, &_temp); + if (!ret) + *temp = (unsigned long)_temp; + + return ret; +} + +static int backport_thermal_set_trip_temp(struct thermal_zone_device *dev, + int i, unsigned long temp) +{ + struct backport_thermal_ops_wrapper *wrapper = + container_of(dev->ops, struct backport_thermal_ops_wrapper, ops); + + return wrapper->driver_ops->set_trip_temp(dev, i, (int)temp); +} + +static int backport_thermal_get_trip_hyst(struct thermal_zone_device *dev, + int i, unsigned long *temp) +{ + struct backport_thermal_ops_wrapper *wrapper = + container_of(dev->ops, struct backport_thermal_ops_wrapper, ops); + int _temp, ret; + + ret = wrapper->driver_ops->get_trip_hyst(dev, i, &_temp); + if (!ret) + *temp = (unsigned long)_temp; + + return ret; +} + +static int backport_thermal_set_trip_hyst(struct thermal_zone_device *dev, + int i, unsigned long temp) +{ + struct backport_thermal_ops_wrapper *wrapper = + container_of(dev->ops, struct backport_thermal_ops_wrapper, ops); + + return wrapper->driver_ops->set_trip_hyst(dev, i, (int)temp); +} + +static int backport_thermal_get_crit_temp(struct thermal_zone_device *dev, + unsigned long *temp) +{ + struct backport_thermal_ops_wrapper *wrapper = + container_of(dev->ops, struct backport_thermal_ops_wrapper, ops); + int _temp, ret; + + ret = wrapper->driver_ops->get_crit_temp(dev, &_temp); + if (!ret) + *temp = (unsigned long)_temp; + + return ret; +} + +#if LINUX_VERSION_IS_GEQ(3, 19, 0) +static int backport_thermal_set_emul_temp(struct thermal_zone_device *dev, + unsigned long temp) +{ + struct backport_thermal_ops_wrapper *wrapper = + container_of(dev->ops, struct backport_thermal_ops_wrapper, ops); + + return wrapper->driver_ops->set_emul_temp(dev, (int)temp); +} +#endif /* LINUX_VERSION_IS_GEQ(3, 19, 0) */ + +struct thermal_zone_device *backport_thermal_zone_device_register( + const char *type, int trips, int mask, void *devdata, + struct thermal_zone_device_ops *ops, + const struct thermal_zone_params *tzp, + int passive_delay, int polling_delay) +{ + struct backport_thermal_ops_wrapper *wrapper = kzalloc(sizeof(*wrapper), GFP_KERNEL); + struct thermal_zone_device *ret; + + if (!wrapper) + return NULL; + + wrapper->driver_ops = ops; + +#define copy(_op) \ + wrapper->ops._op = ops->_op + + copy(bind); + copy(unbind); + copy(get_mode); + copy(set_mode); + copy(get_trip_type); + copy(get_trend); + copy(notify); + + /* Assign the backport ops to the old struct to get the + * correct types. But only assign if the registrant defined + * the ops. + */ +#define assign_ops(_op) \ + if (ops->_op) \ + wrapper->ops._op = backport_thermal_##_op + + assign_ops(get_temp); + assign_ops(get_trip_temp); + assign_ops(set_trip_temp); + assign_ops(get_trip_hyst); + assign_ops(set_trip_hyst); + assign_ops(get_crit_temp); +#if LINUX_VERSION_IS_GEQ(3, 19, 0) + assign_ops(set_emul_temp); +#endif /* LINUX_VERSION_IS_GEQ(3, 19, 0) */ +#undef assign_ops + + ret = old_thermal_zone_device_register(type, trips, mask, devdata, + &wrapper->ops, tzp, passive_delay, + polling_delay); + if (!ret) + kfree(wrapper); + return ret; +} +EXPORT_SYMBOL_GPL(backport_thermal_zone_device_register); + +void backport_thermal_zone_device_unregister(struct thermal_zone_device *dev) +{ + struct backport_thermal_ops_wrapper *wrapper = + container_of(dev->ops, struct backport_thermal_ops_wrapper, ops); + + old_thermal_zone_device_unregister(dev); + kfree(wrapper); +} +EXPORT_SYMBOL_GPL(backport_thermal_zone_device_unregister); + +#endif /* >= 3.8.0 */ +#endif /* CONFIG_THERMAL */ + +static void seq_set_overflow(struct seq_file *m) +{ + m->count = m->size; +} + +/* A complete analogue of print_hex_dump() */ +void seq_hex_dump(struct seq_file *m, const char *prefix_str, int prefix_type, + int rowsize, int groupsize, const void *buf, size_t len, + bool ascii) +{ + const u8 *ptr = buf; + int i, linelen, remaining = len; + int ret; + + if (rowsize != 16 && rowsize != 32) + rowsize = 16; + + for (i = 0; i < len && !seq_has_overflowed(m); i += rowsize) { + linelen = min(remaining, rowsize); + remaining -= rowsize; + + switch (prefix_type) { + case DUMP_PREFIX_ADDRESS: + seq_printf(m, "%s%p: ", prefix_str, ptr + i); + break; + case DUMP_PREFIX_OFFSET: + seq_printf(m, "%s%.8x: ", prefix_str, i); + break; + default: + seq_printf(m, "%s", prefix_str); + break; + } + + ret = hex_dump_to_buffer(ptr + i, linelen, rowsize, groupsize, + m->buf + m->count, m->size - m->count, + ascii); + if (ret >= m->size - m->count) { + seq_set_overflow(m); + } else { + m->count += ret; + seq_putc(m, '\n'); + } + } +} +EXPORT_SYMBOL_GPL(seq_hex_dump); + +ssize_t strscpy(char *dest, const char *src, size_t count) +{ + long res = 0; + + if (count == 0) + return -E2BIG; + + while (count) { + char c; + + c = src[res]; + dest[res] = c; + if (!c) + return res; + res++; + count--; + } + + /* Hit buffer length without finding a NUL; force NUL-termination. */ + if (res) + dest[res-1] = '\0'; + + return -E2BIG; +} +EXPORT_SYMBOL_GPL(strscpy); + +static void *device_get_mac_addr(struct device *dev, + const char *name, char *addr, + int alen) +{ +#if LINUX_VERSION_IS_GEQ(3,18,0) + int ret = device_property_read_u8_array(dev, name, addr, alen); +#else + int ret = of_property_read_u8_array(dev->of_node, name, addr, alen); +#endif + + if (ret == 0 && alen == ETH_ALEN && is_valid_ether_addr(addr)) + return addr; + return NULL; +} + +/** + * device_get_mac_address - Get the MAC for a given device + * @dev: Pointer to the device + * @addr: Address of buffer to store the MAC in + * @alen: Length of the buffer pointed to by addr, should be ETH_ALEN + * + * Search the firmware node for the best MAC address to use. 'mac-address' is + * checked first, because that is supposed to contain to "most recent" MAC + * address. If that isn't set, then 'local-mac-address' is checked next, + * because that is the default address. If that isn't set, then the obsolete + * 'address' is checked, just in case we're using an old device tree. + * + * Note that the 'address' property is supposed to contain a virtual address of + * the register set, but some DTS files have redefined that property to be the + * MAC address. + * + * All-zero MAC addresses are rejected, because those could be properties that + * exist in the firmware tables, but were not updated by the firmware. For + * example, the DTS could define 'mac-address' and 'local-mac-address', with + * zero MAC addresses. Some older U-Boots only initialized 'local-mac-address'. + * In this case, the real MAC is in 'local-mac-address', and 'mac-address' + * exists but is all zeros. +*/ +void *device_get_mac_address(struct device *dev, char *addr, int alen) +{ + char *res; + + res = device_get_mac_addr(dev, "mac-address", addr, alen); + if (res) + return res; + + res = device_get_mac_addr(dev, "local-mac-address", addr, alen); + if (res) + return res; + + return device_get_mac_addr(dev, "address", addr, alen); +} +EXPORT_SYMBOL_GPL(device_get_mac_address); |