1/* 2 * Copyright (C) 2009 Francisco Jerez. 3 * All Rights Reserved. 4 * 5 * Permission is hereby granted, free of charge, to any person obtaining 6 * a copy of this software and associated documentation files (the 7 * "Software"), to deal in the Software without restriction, including 8 * without limitation the rights to use, copy, modify, merge, publish, 9 * distribute, sublicense, and/or sell copies of the Software, and to 10 * permit persons to whom the Software is furnished to do so, subject to 11 * the following conditions: 12 * 13 * The above copyright notice and this permission notice (including the 14 * next paragraph) shall be included in all copies or substantial 15 * portions of the Software. 16 * 17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 18 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 19 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. 20 * IN NO EVENT SHALL THE COPYRIGHT OWNER(S) AND/OR ITS SUPPLIERS BE 21 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION 22 * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION 23 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. 24 * 25 */ 26 27#include "drmP.h" 28#include "nouveau_drv.h" 29#include "nouveau_hw.h" 30 31static bool 32get_gpio_location(struct dcb_gpio_entry *ent, uint32_t *reg, uint32_t *shift, 33 uint32_t *mask) 34{ 35 if (ent->line < 2) { 36 *reg = NV_PCRTC_GPIO; 37 *shift = ent->line * 16; 38 *mask = 0x11; 39 40 } else if (ent->line < 10) { 41 *reg = NV_PCRTC_GPIO_EXT; 42 *shift = (ent->line - 2) * 4; 43 *mask = 0x3; 44 45 } else if (ent->line < 14) { 46 *reg = NV_PCRTC_850; 47 *shift = (ent->line - 10) * 4; 48 *mask = 0x3; 49 50 } else { 51 return false; 52 } 53 54 return true; 55} 56 57int 58nv10_gpio_get(struct drm_device *dev, enum dcb_gpio_tag tag) 59{ 60 struct dcb_gpio_entry *ent = nouveau_bios_gpio_entry(dev, tag); 61 uint32_t reg, shift, mask, value; 62 63 if (!ent) 64 return -ENODEV; 65 66 if (!get_gpio_location(ent, ®, &shift, &mask)) 67 return -ENODEV; 68 69 value = NVReadCRTC(dev, 0, reg) >> shift; 70 71 return (ent->invert ? 1 : 0) ^ (value & 1); 72} 73 74int 75nv10_gpio_set(struct drm_device *dev, enum dcb_gpio_tag tag, int state) 76{ 77 struct dcb_gpio_entry *ent = nouveau_bios_gpio_entry(dev, tag); 78 uint32_t reg, shift, mask, value; 79 80 if (!ent) 81 return -ENODEV; 82 83 if (!get_gpio_location(ent, ®, &shift, &mask)) 84 return -ENODEV; 85 86 value = ((ent->invert ? 1 : 0) ^ (state ? 1 : 0)) << shift; 87 mask = ~(mask << shift); 88 89 NVWriteCRTC(dev, 0, reg, value | (NVReadCRTC(dev, 0, reg) & mask)); 90 91 return 0; 92} 93