Mike Rapoport | 67088d4 | 2015-09-22 12:01:16 +0300 | [diff] [blame] | 1 | #include <linux/module.h> |
| 2 | #include <linux/kernel.h> |
| 3 | #include <linux/errno.h> |
| 4 | #include <linux/string.h> |
| 5 | #include <linux/mm.h> |
| 6 | #include <linux/slab.h> |
| 7 | #include <linux/delay.h> |
| 8 | #include <linux/fb.h> |
| 9 | #include <linux/ioport.h> |
| 10 | #include <linux/init.h> |
| 11 | #include <linux/pci.h> |
| 12 | #include <linux/vmalloc.h> |
| 13 | #include <linux/pagemap.h> |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 14 | #include <linux/console.h> |
Mike Rapoport | 67088d4 | 2015-09-22 12:01:16 +0300 | [diff] [blame] | 15 | #include <linux/platform_device.h> |
| 16 | #include <linux/screen_info.h> |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 17 | |
| 18 | #include "sm750.h" |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 19 | #include "sm750_cursor.h" |
| 20 | |
| 21 | |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 22 | |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 23 | #define POKE32(addr, data) \ |
| 24 | writel((data), cursor->mmio + (addr)) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 25 | |
| 26 | /* cursor control for voyager and 718/750*/ |
| 27 | #define HWC_ADDRESS 0x0 |
Mike Rapoport | 672f75b | 2016-02-15 19:53:54 +0200 | [diff] [blame] | 28 | #define HWC_ADDRESS_ENABLE BIT(31) |
| 29 | #define HWC_ADDRESS_EXT BIT(27) |
| 30 | #define HWC_ADDRESS_CS BIT(26) |
| 31 | #define HWC_ADDRESS_ADDRESS_MASK 0x3ffffff |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 32 | |
| 33 | #define HWC_LOCATION 0x4 |
Mike Rapoport | fe3bd26 | 2016-02-15 19:53:55 +0200 | [diff] [blame] | 34 | #define HWC_LOCATION_TOP BIT(27) |
| 35 | #define HWC_LOCATION_Y_SHIFT 16 |
| 36 | #define HWC_LOCATION_Y_MASK (0x7ff << 16) |
| 37 | #define HWC_LOCATION_LEFT BIT(11) |
| 38 | #define HWC_LOCATION_X_MASK 0x7ff |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 39 | |
| 40 | #define HWC_COLOR_12 0x8 |
Mike Rapoport | 6aa178e | 2016-02-15 19:53:56 +0200 | [diff] [blame] | 41 | #define HWC_COLOR_12_2_RGB565_SHIFT 16 |
| 42 | #define HWC_COLOR_12_2_RGB565_MASK (0xffff << 16) |
| 43 | #define HWC_COLOR_12_1_RGB565_MASK 0xffff |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 44 | |
| 45 | #define HWC_COLOR_3 0xC |
Mike Rapoport | 6aa178e | 2016-02-15 19:53:56 +0200 | [diff] [blame] | 46 | #define HWC_COLOR_3_RGB565_MASK 0xffff |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 47 | |
| 48 | |
| 49 | /* hw_cursor_xxx works for voyager,718 and 750 */ |
Greg Donald | eb0f427 | 2015-06-18 15:06:56 -0500 | [diff] [blame] | 50 | void hw_cursor_enable(struct lynx_cursor *cursor) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 51 | { |
| 52 | u32 reg; |
Juston Li | 40403c1 | 2015-07-14 21:14:48 -0700 | [diff] [blame] | 53 | |
Mike Rapoport | 672f75b | 2016-02-15 19:53:54 +0200 | [diff] [blame] | 54 | reg = (cursor->offset & HWC_ADDRESS_ADDRESS_MASK) | HWC_ADDRESS_ENABLE; |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 55 | POKE32(HWC_ADDRESS, reg); |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 56 | } |
Greg Donald | eb0f427 | 2015-06-18 15:06:56 -0500 | [diff] [blame] | 57 | void hw_cursor_disable(struct lynx_cursor *cursor) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 58 | { |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 59 | POKE32(HWC_ADDRESS, 0); |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 60 | } |
| 61 | |
Greg Donald | eb0f427 | 2015-06-18 15:06:56 -0500 | [diff] [blame] | 62 | void hw_cursor_setSize(struct lynx_cursor *cursor, |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 63 | int w, int h) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 64 | { |
| 65 | cursor->w = w; |
| 66 | cursor->h = h; |
| 67 | } |
Greg Donald | eb0f427 | 2015-06-18 15:06:56 -0500 | [diff] [blame] | 68 | void hw_cursor_setPos(struct lynx_cursor *cursor, |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 69 | int x, int y) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 70 | { |
| 71 | u32 reg; |
Juston Li | 40403c1 | 2015-07-14 21:14:48 -0700 | [diff] [blame] | 72 | |
Mike Rapoport | fe3bd26 | 2016-02-15 19:53:55 +0200 | [diff] [blame] | 73 | reg = (((y << HWC_LOCATION_Y_SHIFT) & HWC_LOCATION_Y_MASK) | |
| 74 | (x & HWC_LOCATION_X_MASK)); |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 75 | POKE32(HWC_LOCATION, reg); |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 76 | } |
Greg Donald | eb0f427 | 2015-06-18 15:06:56 -0500 | [diff] [blame] | 77 | void hw_cursor_setColor(struct lynx_cursor *cursor, |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 78 | u32 fg, u32 bg) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 79 | { |
Mike Rapoport | 6aa178e | 2016-02-15 19:53:56 +0200 | [diff] [blame] | 80 | u32 reg = (fg << HWC_COLOR_12_2_RGB565_SHIFT) & |
| 81 | HWC_COLOR_12_2_RGB565_MASK; |
| 82 | |
| 83 | POKE32(HWC_COLOR_12, reg | (bg & HWC_COLOR_12_1_RGB565_MASK)); |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 84 | POKE32(HWC_COLOR_3, 0xffe0); |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 85 | } |
| 86 | |
Greg Donald | eb0f427 | 2015-06-18 15:06:56 -0500 | [diff] [blame] | 87 | void hw_cursor_setData(struct lynx_cursor *cursor, |
Yash Shah | cc6c16d | 2015-08-14 06:06:13 +0000 | [diff] [blame] | 88 | u16 rop, const u8 *pcol, const u8 *pmsk) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 89 | { |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 90 | int i, j, count, pitch, offset; |
| 91 | u8 color, mask, opr; |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 92 | u16 data; |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 93 | void __iomem *pbuffer, *pstart; |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 94 | |
| 95 | /* in byte*/ |
| 96 | pitch = cursor->w >> 3; |
| 97 | |
| 98 | /* in byte */ |
| 99 | count = pitch * cursor->h; |
| 100 | |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 101 | /* in byte */ |
| 102 | offset = cursor->maxW * 2 / 8; |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 103 | |
| 104 | data = 0; |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 105 | pstart = cursor->vstart; |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 106 | pbuffer = pstart; |
| 107 | |
Juston Li | 259fef3 | 2015-07-14 21:14:45 -0700 | [diff] [blame] | 108 | for (i = 0; i < count; i++) { |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 109 | color = *pcol++; |
| 110 | mask = *pmsk++; |
| 111 | data = 0; |
| 112 | |
Juston Li | adbb90e | 2015-07-14 21:14:42 -0700 | [diff] [blame] | 113 | for (j = 0; j < 8; j++) { |
Juston Li | 8c11f5a | 2015-07-14 21:14:35 -0700 | [diff] [blame] | 114 | if (mask & (0x80>>j)) { |
Juston Li | 9ccc5f4 | 2015-07-14 21:14:33 -0700 | [diff] [blame] | 115 | if (rop == ROP_XOR) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 116 | opr = mask ^ color; |
| 117 | else |
| 118 | opr = mask & color; |
| 119 | |
| 120 | /* 2 stands for forecolor and 1 for backcolor */ |
| 121 | data |= ((opr & (0x80>>j))?2:1)<<(j*2); |
| 122 | } |
| 123 | } |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 124 | iowrite16(data, pbuffer); |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 125 | |
| 126 | /* assume pitch is 1,2,4,8,...*/ |
Othmar Pasteka | 04c73f2 | 2015-11-08 11:58:51 +0100 | [diff] [blame] | 127 | if ((i + 1) % pitch == 0) { |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 128 | /* need a return */ |
| 129 | pstart += offset; |
| 130 | pbuffer = pstart; |
Juston Li | 6338a781 | 2015-07-14 21:14:36 -0700 | [diff] [blame] | 131 | } else { |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 132 | pbuffer += sizeof(u16); |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 133 | } |
| 134 | |
| 135 | } |
| 136 | |
| 137 | |
| 138 | } |
| 139 | |
| 140 | |
Greg Donald | eb0f427 | 2015-06-18 15:06:56 -0500 | [diff] [blame] | 141 | void hw_cursor_setData2(struct lynx_cursor *cursor, |
Yash Shah | cc6c16d | 2015-08-14 06:06:13 +0000 | [diff] [blame] | 142 | u16 rop, const u8 *pcol, const u8 *pmsk) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 143 | { |
Isaac Assegai | c97b2c1 | 2015-06-02 03:14:26 -0700 | [diff] [blame] | 144 | int i, j, count, pitch, offset; |
Sudip Mukherjee | 041d3a4 | 2015-03-10 22:46:53 +0530 | [diff] [blame] | 145 | u8 color, mask; |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 146 | u16 data; |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 147 | void __iomem *pbuffer, *pstart; |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 148 | |
| 149 | /* in byte*/ |
| 150 | pitch = cursor->w >> 3; |
| 151 | |
| 152 | /* in byte */ |
| 153 | count = pitch * cursor->h; |
| 154 | |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 155 | /* in byte */ |
| 156 | offset = cursor->maxW * 2 / 8; |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 157 | |
| 158 | data = 0; |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 159 | pstart = cursor->vstart; |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 160 | pbuffer = pstart; |
| 161 | |
Juston Li | 259fef3 | 2015-07-14 21:14:45 -0700 | [diff] [blame] | 162 | for (i = 0; i < count; i++) { |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 163 | color = *pcol++; |
| 164 | mask = *pmsk++; |
| 165 | data = 0; |
| 166 | |
Juston Li | adbb90e | 2015-07-14 21:14:42 -0700 | [diff] [blame] | 167 | for (j = 0; j < 8; j++) { |
Juston Li | 9ccc5f4 | 2015-07-14 21:14:33 -0700 | [diff] [blame] | 168 | if (mask & (1<<j)) |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 169 | data |= ((color & (1<<j))?1:2)<<(j*2); |
| 170 | } |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 171 | iowrite16(data, pbuffer); |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 172 | |
| 173 | /* assume pitch is 1,2,4,8,...*/ |
Juston Li | 259fef3 | 2015-07-14 21:14:45 -0700 | [diff] [blame] | 174 | if (!(i&(pitch-1))) { |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 175 | /* need a return */ |
| 176 | pstart += offset; |
| 177 | pbuffer = pstart; |
Juston Li | 6338a781 | 2015-07-14 21:14:36 -0700 | [diff] [blame] | 178 | } else { |
Lorenzo Stoakes | 35fb80b | 2015-03-20 15:22:14 +0000 | [diff] [blame] | 179 | pbuffer += sizeof(u16); |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 180 | } |
| 181 | |
| 182 | } |
Sudip Mukherjee | 81dee67 | 2015-03-03 16:21:06 +0530 | [diff] [blame] | 183 | } |