1a522946174b5ae389af0856c422d865a63c70316Ben Skeggs/* 2a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * Copyright 2014 Red Hat Inc. 3a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * 4a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * Permission is hereby granted, free of charge, to any person obtaining a 5a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * copy of this software and associated documentation files (the "Software"), 6a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * to deal in the Software without restriction, including without limitation 7a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * and/or sell copies of the Software, and to permit persons to whom the 9a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * Software is furnished to do so, subject to the following conditions: 10a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * 11a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * The above copyright notice and this permission notice shall be included in 12a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * all copies or substantial portions of the Software. 13a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * 14a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 15a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 16a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 17a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR 18a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 19a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 20a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * OTHER DEALINGS IN THE SOFTWARE. 21a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * 22a522946174b5ae389af0856c422d865a63c70316Ben Skeggs * Authors: Ben Skeggs 23a522946174b5ae389af0856c422d865a63c70316Ben Skeggs */ 24a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 25a522946174b5ae389af0856c422d865a63c70316Ben Skeggs#include <core/client.h> 26a522946174b5ae389af0856c422d865a63c70316Ben Skeggs#include <nvif/unpack.h> 27a522946174b5ae389af0856c422d865a63c70316Ben Skeggs#include <nvif/class.h> 28a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 29a522946174b5ae389af0856c422d865a63c70316Ben Skeggs#include "nv50.h" 30a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 31a522946174b5ae389af0856c422d865a63c70316Ben Skeggsint 32a522946174b5ae389af0856c422d865a63c70316Ben Skeggsnve0_hdmi_ctrl(NV50_DISP_MTHD_V1) 33a522946174b5ae389af0856c422d865a63c70316Ben Skeggs{ 34a522946174b5ae389af0856c422d865a63c70316Ben Skeggs const u32 hoff = (head * 0x800); 35a522946174b5ae389af0856c422d865a63c70316Ben Skeggs const u32 hdmi = (head * 0x400); 36a522946174b5ae389af0856c422d865a63c70316Ben Skeggs union { 37a522946174b5ae389af0856c422d865a63c70316Ben Skeggs struct nv50_disp_sor_hdmi_pwr_v0 v0; 38a522946174b5ae389af0856c422d865a63c70316Ben Skeggs } *args = data; 39a522946174b5ae389af0856c422d865a63c70316Ben Skeggs u32 ctrl; 40a522946174b5ae389af0856c422d865a63c70316Ben Skeggs int ret; 41a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 42a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_ioctl(object, "disp sor hdmi ctrl size %d\n", size); 43a522946174b5ae389af0856c422d865a63c70316Ben Skeggs if (nvif_unpack(args->v0, 0, 0, false)) { 44a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_ioctl(object, "disp sor hdmi ctrl vers %d state %d " 45a522946174b5ae389af0856c422d865a63c70316Ben Skeggs "max_ac_packet %d rekey %d\n", 46a522946174b5ae389af0856c422d865a63c70316Ben Skeggs args->v0.version, args->v0.state, 47a522946174b5ae389af0856c422d865a63c70316Ben Skeggs args->v0.max_ac_packet, args->v0.rekey); 48a522946174b5ae389af0856c422d865a63c70316Ben Skeggs if (args->v0.max_ac_packet > 0x1f || args->v0.rekey > 0x7f) 49a522946174b5ae389af0856c422d865a63c70316Ben Skeggs return -EINVAL; 50a522946174b5ae389af0856c422d865a63c70316Ben Skeggs ctrl = 0x40000000 * !!args->v0.state; 51a522946174b5ae389af0856c422d865a63c70316Ben Skeggs ctrl |= args->v0.max_ac_packet << 16; 52a522946174b5ae389af0856c422d865a63c70316Ben Skeggs ctrl |= args->v0.rekey; 53a522946174b5ae389af0856c422d865a63c70316Ben Skeggs } else 54a522946174b5ae389af0856c422d865a63c70316Ben Skeggs return ret; 55a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 56a522946174b5ae389af0856c422d865a63c70316Ben Skeggs if (!(ctrl & 0x40000000)) { 57a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_mask(priv, 0x616798 + hoff, 0x40000000, 0x00000000); 58a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_mask(priv, 0x6900c0 + hdmi, 0x00000001, 0x00000000); 59a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_mask(priv, 0x690000 + hdmi, 0x00000001, 0x00000000); 60a522946174b5ae389af0856c422d865a63c70316Ben Skeggs return 0; 61a522946174b5ae389af0856c422d865a63c70316Ben Skeggs } 62a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 63a522946174b5ae389af0856c422d865a63c70316Ben Skeggs /* AVI InfoFrame */ 64a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_mask(priv, 0x690000 + hdmi, 0x00000001, 0x00000000); 65a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_wr32(priv, 0x690008 + hdmi, 0x000d0282); 66a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_wr32(priv, 0x69000c + hdmi, 0x0000006f); 67a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_wr32(priv, 0x690010 + hdmi, 0x00000000); 68a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_wr32(priv, 0x690014 + hdmi, 0x00000000); 69a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_wr32(priv, 0x690018 + hdmi, 0x00000000); 70a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_mask(priv, 0x690000 + hdmi, 0x00000001, 0x00000001); 71a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 72a522946174b5ae389af0856c422d865a63c70316Ben Skeggs /* ??? InfoFrame? */ 73a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_mask(priv, 0x6900c0 + hdmi, 0x00000001, 0x00000000); 74a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_wr32(priv, 0x6900cc + hdmi, 0x00000010); 75a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_mask(priv, 0x6900c0 + hdmi, 0x00000001, 0x00000001); 76a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 77a522946174b5ae389af0856c422d865a63c70316Ben Skeggs /* ??? */ 78a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_wr32(priv, 0x690080 + hdmi, 0x82000000); 79a522946174b5ae389af0856c422d865a63c70316Ben Skeggs 80a522946174b5ae389af0856c422d865a63c70316Ben Skeggs /* HDMI_CTRL */ 81a522946174b5ae389af0856c422d865a63c70316Ben Skeggs nv_mask(priv, 0x616798 + hoff, 0x401f007f, ctrl); 82a522946174b5ae389af0856c422d865a63c70316Ben Skeggs return 0; 83a522946174b5ae389af0856c422d865a63c70316Ben Skeggs} 84