From: Kevin Brace <kevinbrace@xxxxxxxxxxxxxxxxxxxx> Signed-off-by: Kevin Brace <kevinbrace@xxxxxxxxxxxxxxxxxxxx> --- drivers/gpu/drm/via/via_crtc_hw.c | 91 +++++++++++++++++++++++++++++++ 1 file changed, 91 insertions(+) create mode 100644 drivers/gpu/drm/via/via_crtc_hw.c diff --git a/drivers/gpu/drm/via/via_crtc_hw.c b/drivers/gpu/drm/via/via_crtc_hw.c new file mode 100644 index 000000000000..f5446da52c0f --- /dev/null +++ b/drivers/gpu/drm/via/via_crtc_hw.c @@ -0,0 +1,91 @@ +/* + * Copyright 2012 James Simmons. All Rights Reserved. + * + * Permission is hereby granted, free of charge, to any person obtaining a + * copy of this software and associated documentation files (the "Software"), + * to deal in the Software without restriction, including without limitation + * the rights to use, copy, modify, merge, publish, distribute, sub license, + * and/or sell copies of the Software, and to permit persons to whom the + * Software is furnished to do so, subject to the following conditions: + * + * The above copyright notice and this permission notice (including the + * next paragraph) shall be included in all copies or substantial portions + * of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR + * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, + * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL + * THE AUTHOR(S) OR COPYRIGHT HOLDER(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR + * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, + * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER + * DEALINGS IN THE SOFTWARE. + * + * Author(s): + * James Simmons <jsimmons@xxxxxxxxxxxxx> + */ + +#include <video/vga.h> + +#include "via_crtc_hw.h" + +/* + * load_register_table enables the ability to set entire + * tables of registers. For each register defined by the + * port and the index for that register is programmed + * with a masked value. + */ +void +load_register_tables(void __iomem *regbase, struct vga_registers *regs) +{ + u8 cr_index, orig, reg_mask, data; + unsigned int i; + u16 port; + + for (i = 0; i < regs->count; i++) { + reg_mask = regs->regs[i].start_bit; + data = regs->regs[i].end_bit; + cr_index = regs->regs[i].io_addr; + port = regs->regs[i].ioport; + + vga_w(regbase, port, cr_index); + orig = (vga_r(regbase, port + 1) & ~reg_mask); + vga_w(regbase, port + 1, ((data & reg_mask) | orig)); + } +} + +/* + * Due to the limitation of how much data you can write to a single + * register we run into data that can't be written in only one register. + * So load_value_to_register was developed to be able to define register + * tables that can load different bit ranges of the data to different + * registers. + */ +void +load_value_to_registers(void __iomem *regbase, struct vga_registers *regs, + unsigned int value) +{ + unsigned int bit_num = 0, shift_next_reg, reg_mask; + u8 start_index, end_index, cr_index, orig; + unsigned int data, i, j; + u16 get_bit, port; + + for (i = 0; i < regs->count; i++) { + start_index = regs->regs[i].start_bit; + end_index = regs->regs[i].end_bit; + cr_index = regs->regs[i].io_addr; + port = regs->regs[i].ioport; + reg_mask = data = 0; + + shift_next_reg = bit_num; + for (j = start_index; j <= end_index; j++) { + reg_mask = reg_mask | (1 << j); + get_bit = (value & (1 << bit_num)); + data |= ((get_bit >> shift_next_reg) << start_index); + bit_num++; + } + + vga_w(regbase, port, cr_index); + orig = (vga_r(regbase, port + 1) & ~reg_mask); + vga_w(regbase, port + 1, ((data & reg_mask) | orig)); + } +} -- 2.35.1