111 lines · c
1/*2 * Copyright 2012 Red Hat Inc.3 *4 * Permission is hereby granted, free of charge, to any person obtaining a5 * copy of this software and associated documentation files (the "Software"),6 * to deal in the Software without restriction, including without limitation7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,8 * and/or sell copies of the Software, and to permit persons to whom the9 * Software is furnished to do so, subject to the following conditions:10 *11 * The above copyright notice and this permission notice shall be included in12 * all copies or substantial portions of the Software.13 *14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR20 * OTHER DEALINGS IN THE SOFTWARE.21 *22 * Authors: Ben Skeggs23 * Martin Peres24 */25#include "priv.h"26 27#include <core/option.h>28#include <subdev/bios.h>29#include <subdev/bios/fan.h>30#include <subdev/gpio.h>31 32struct nvkm_fanpwm {33 struct nvkm_fan base;34 struct dcb_gpio_func func;35};36 37static int38nvkm_fanpwm_get(struct nvkm_therm *therm)39{40 struct nvkm_fanpwm *fan = (void *)therm->fan;41 struct nvkm_device *device = therm->subdev.device;42 struct nvkm_gpio *gpio = device->gpio;43 int card_type = device->card_type;44 u32 divs, duty;45 int ret;46 47 ret = therm->func->pwm_get(therm, fan->func.line, &divs, &duty);48 if (ret == 0 && divs) {49 divs = max(divs, duty);50 if (card_type <= NV_40 || (fan->func.log[0] & 1))51 duty = divs - duty;52 return (duty * 100) / divs;53 }54 55 return nvkm_gpio_get(gpio, 0, fan->func.func, fan->func.line) * 100;56}57 58static int59nvkm_fanpwm_set(struct nvkm_therm *therm, int percent)60{61 struct nvkm_fanpwm *fan = (void *)therm->fan;62 int card_type = therm->subdev.device->card_type;63 u32 divs, duty;64 int ret;65 66 divs = fan->base.perf.pwm_divisor;67 if (fan->base.bios.pwm_freq) {68 divs = 1;69 if (therm->func->pwm_clock)70 divs = therm->func->pwm_clock(therm, fan->func.line);71 divs /= fan->base.bios.pwm_freq;72 }73 74 duty = ((divs * percent) + 99) / 100;75 if (card_type <= NV_40 || (fan->func.log[0] & 1))76 duty = divs - duty;77 78 ret = therm->func->pwm_set(therm, fan->func.line, divs, duty);79 if (ret == 0)80 ret = therm->func->pwm_ctrl(therm, fan->func.line, true);81 return ret;82}83 84int85nvkm_fanpwm_create(struct nvkm_therm *therm, struct dcb_gpio_func *func)86{87 struct nvkm_device *device = therm->subdev.device;88 struct nvkm_bios *bios = device->bios;89 struct nvkm_fanpwm *fan;90 struct nvbios_therm_fan info = {};91 u32 divs, duty;92 93 nvbios_fan_parse(bios, &info);94 95 if (!nvkm_boolopt(device->cfgopt, "NvFanPWM", func->param) ||96 !therm->func->pwm_ctrl || info.type == NVBIOS_THERM_FAN_TOGGLE ||97 therm->func->pwm_get(therm, func->line, &divs, &duty) == -ENODEV)98 return -ENODEV;99 100 fan = kzalloc(sizeof(*fan), GFP_KERNEL);101 if (!fan)102 return -ENOMEM;103 104 therm->fan = &fan->base;105 fan->base.type = "PWM";106 fan->base.get = nvkm_fanpwm_get;107 fan->base.set = nvkm_fanpwm_set;108 fan->func = *func;109 return 0;110}111