168 lines · c
1/*2 * Copyright 2013 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 */24#include "priv.h"25 26#include <core/firmware.h>27#include <subdev/timer.h>28 29bool30nvkm_pmu_fan_controlled(struct nvkm_device *device)31{32 struct nvkm_pmu *pmu = device->pmu;33 34 /* Internal PMU FW does not currently control fans in any way,35 * allow SW control of fans instead.36 */37 if (pmu && pmu->func->code.size)38 return false;39 40 /* Default (board-loaded, or VBIOS PMU/PREOS) PMU FW on Fermi41 * and newer automatically control the fan speed, which would42 * interfere with SW control.43 */44 return (device->chipset >= 0xc0);45}46 47void48nvkm_pmu_pgob(struct nvkm_pmu *pmu, bool enable)49{50 if (pmu && pmu->func->pgob)51 pmu->func->pgob(pmu, enable);52}53 54static void55nvkm_pmu_recv(struct work_struct *work)56{57 struct nvkm_pmu *pmu = container_of(work, typeof(*pmu), recv.work);58 return pmu->func->recv(pmu);59}60 61int62nvkm_pmu_send(struct nvkm_pmu *pmu, u32 reply[2],63 u32 process, u32 message, u32 data0, u32 data1)64{65 if (!pmu || !pmu->func->send)66 return -ENODEV;67 return pmu->func->send(pmu, reply, process, message, data0, data1);68}69 70static void71nvkm_pmu_intr(struct nvkm_subdev *subdev)72{73 struct nvkm_pmu *pmu = nvkm_pmu(subdev);74 if (!pmu->func->intr)75 return;76 pmu->func->intr(pmu);77}78 79static int80nvkm_pmu_fini(struct nvkm_subdev *subdev, bool suspend)81{82 struct nvkm_pmu *pmu = nvkm_pmu(subdev);83 84 if (!subdev->use.enabled)85 return 0;86 87 if (pmu->func->fini)88 pmu->func->fini(pmu);89 90 return 0;91}92 93static int94nvkm_pmu_init(struct nvkm_subdev *subdev)95{96 struct nvkm_pmu *pmu = nvkm_pmu(subdev);97 98 if (!pmu->func->init)99 return 0;100 101 return pmu->func->init(pmu);102}103 104static void *105nvkm_pmu_dtor(struct nvkm_subdev *subdev)106{107 struct nvkm_pmu *pmu = nvkm_pmu(subdev);108 nvkm_falcon_msgq_del(&pmu->msgq);109 nvkm_falcon_cmdq_del(&pmu->lpq);110 nvkm_falcon_cmdq_del(&pmu->hpq);111 nvkm_falcon_qmgr_del(&pmu->qmgr);112 nvkm_falcon_dtor(&pmu->falcon);113 mutex_destroy(&pmu->send.mutex);114 return nvkm_pmu(subdev);115}116 117static const struct nvkm_subdev_func118nvkm_pmu = {119 .dtor = nvkm_pmu_dtor,120 .init = nvkm_pmu_init,121 .fini = nvkm_pmu_fini,122 .intr = nvkm_pmu_intr,123};124 125int126nvkm_pmu_ctor(const struct nvkm_pmu_fwif *fwif, struct nvkm_device *device,127 enum nvkm_subdev_type type, int inst, struct nvkm_pmu *pmu)128{129 int ret;130 131 nvkm_subdev_ctor(&nvkm_pmu, device, type, inst, &pmu->subdev);132 133 mutex_init(&pmu->send.mutex);134 135 INIT_WORK(&pmu->recv.work, nvkm_pmu_recv);136 init_waitqueue_head(&pmu->recv.wait);137 138 fwif = nvkm_firmware_load(&pmu->subdev, fwif, "Pmu", pmu);139 if (IS_ERR(fwif))140 return PTR_ERR(fwif);141 142 pmu->func = fwif->func;143 144 ret = nvkm_falcon_ctor(pmu->func->flcn, &pmu->subdev, pmu->subdev.name,145 0x10a000, &pmu->falcon);146 if (ret)147 return ret;148 149 if ((ret = nvkm_falcon_qmgr_new(&pmu->falcon, &pmu->qmgr)) ||150 (ret = nvkm_falcon_cmdq_new(pmu->qmgr, "hpq", &pmu->hpq)) ||151 (ret = nvkm_falcon_cmdq_new(pmu->qmgr, "lpq", &pmu->lpq)) ||152 (ret = nvkm_falcon_msgq_new(pmu->qmgr, "msgq", &pmu->msgq)))153 return ret;154 155 init_completion(&pmu->wpr_ready);156 return 0;157}158 159int160nvkm_pmu_new_(const struct nvkm_pmu_fwif *fwif, struct nvkm_device *device,161 enum nvkm_subdev_type type, int inst, struct nvkm_pmu **ppmu)162{163 struct nvkm_pmu *pmu;164 if (!(pmu = *ppmu = kzalloc(sizeof(*pmu), GFP_KERNEL)))165 return -ENOMEM;166 return nvkm_pmu_ctor(fwif, device, type, inst, *ppmu);167}168