1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include "mantis_common.h"
22#include "mantis_core.h"
23#include "mantis_vp1033.h"
24#include "mantis_vp1034.h"
25#include "mantis_vp1041.h"
26#include "mantis_vp2033.h"
27#include "mantis_vp2040.h"
28#include "mantis_vp3030.h"
29
30static int read_eeprom_byte(struct mantis_pci *mantis, u8 *data, u8 length)
31{
32 int err;
33 struct i2c_msg msg[] = {
34 {
35 .addr = 0x50,
36 .flags = 0,
37 .buf = data,
38 .len = 1
39 }, {
40 .addr = 0x50,
41 .flags = I2C_M_RD,
42 .buf = data,
43 .len = length
44 },
45 };
46
47 err = i2c_transfer(&mantis->adapter, msg, 2);
48 if (err < 0) {
49 dprintk(verbose, MANTIS_ERROR, 1,
50 "ERROR: i2c read: < err=%i d0=0x%02x d1=0x%02x >",
51 err, data[0], data[1]);
52
53 return err;
54 }
55
56 return 0;
57}
58
59static int get_mac_address(struct mantis_pci *mantis)
60{
61 int err;
62
63 mantis->mac_address[0] = 0x08;
64 err = read_eeprom_byte(mantis, &mantis->mac_address[0], 6);
65 if (err < 0) {
66 dprintk(verbose, MANTIS_ERROR, 1, "Mantis EEPROM read error");
67
68 return err;
69 }
70 dprintk(verbose, MANTIS_ERROR, 0,
71 " MAC Address=[%pM]\n", mantis->mac_address);
72
73 return 0;
74}
75
76#define MANTIS_MODEL_UNKNOWN "UNKNOWN"
77#define MANTIS_DEV_UNKNOWN "UNKNOWN"
78
79struct mantis_hwconfig unknown_device = {
80 .model_name = MANTIS_MODEL_UNKNOWN,
81 .dev_type = MANTIS_DEV_UNKNOWN,
82};
83
84static void mantis_load_config(struct mantis_pci *mantis)
85{
86 switch (mantis->subsystem_device) {
87 case MANTIS_VP_1033_DVB_S:
88 mantis->hwconfig = &vp1033_mantis_config;
89 break;
90 case MANTIS_VP_1034_DVB_S:
91 mantis->hwconfig = &vp1034_mantis_config;
92 break;
93 case MANTIS_VP_1041_DVB_S2:
94 case TECHNISAT_SKYSTAR_HD2:
95 mantis->hwconfig = &vp1041_mantis_config;
96 break;
97 case MANTIS_VP_2033_DVB_C:
98 mantis->hwconfig = &vp2033_mantis_config;
99 break;
100 case MANTIS_VP_2040_DVB_C:
101 case CINERGY_C:
102 case TECHNISAT_CABLESTAR_HD2:
103 mantis->hwconfig = &vp2040_mantis_config;
104 break;
105 case MANTIS_VP_3030_DVB_T:
106 mantis->hwconfig = &vp3030_mantis_config;
107 break;
108 default:
109 mantis->hwconfig = &unknown_device;
110 break;
111 }
112}
113
114int mantis_core_init(struct mantis_pci *mantis)
115{
116 int err = 0;
117
118 mantis_load_config(mantis);
119 dprintk(verbose, MANTIS_ERROR, 0, "found a %s PCI %s device on (%02x:%02x.%x),\n",
120 mantis->hwconfig->model_name, mantis->hwconfig->dev_type,
121 mantis->pdev->bus->number, PCI_SLOT(mantis->pdev->devfn), PCI_FUNC(mantis->pdev->devfn));
122 dprintk(verbose, MANTIS_ERROR, 0, " Mantis Rev %d [%04x:%04x], ",
123 mantis->revision,
124 mantis->subsystem_vendor, mantis->subsystem_device);
125 dprintk(verbose, MANTIS_ERROR, 0,
126 "irq: %d, latency: %d\n memory: 0x%lx, mmio: 0x%p\n",
127 mantis->pdev->irq, mantis->latency,
128 mantis->mantis_addr, mantis->mantis_mmio);
129
130 err = mantis_i2c_init(mantis);
131 if (err < 0) {
132 dprintk(verbose, MANTIS_ERROR, 1, "Mantis I2C init failed");
133 return err;
134 }
135 err = get_mac_address(mantis);
136 if (err < 0) {
137 dprintk(verbose, MANTIS_ERROR, 1, "get MAC address failed");
138 return err;
139 }
140 err = mantis_dma_init(mantis);
141 if (err < 0) {
142 dprintk(verbose, MANTIS_ERROR, 1, "Mantis DMA init failed");
143 return err;
144 }
145 err = mantis_dvb_init(mantis);
146 if (err < 0) {
147 dprintk(verbose, MANTIS_DEBUG, 1, "Mantis DVB init failed");
148 return err;
149 }
150 err = mantis_uart_init(mantis);
151 if (err < 0) {
152 dprintk(verbose, MANTIS_DEBUG, 1, "Mantis UART init failed");
153 return err;
154 }
155
156 return 0;
157}
158
159int mantis_core_exit(struct mantis_pci *mantis)
160{
161 mantis_dma_stop(mantis);
162 dprintk(verbose, MANTIS_ERROR, 1, "DMA engine stopping");
163
164 mantis_uart_exit(mantis);
165 dprintk(verbose, MANTIS_ERROR, 1, "UART exit failed");
166
167 if (mantis_dma_exit(mantis) < 0)
168 dprintk(verbose, MANTIS_ERROR, 1, "DMA exit failed");
169 if (mantis_dvb_exit(mantis) < 0)
170 dprintk(verbose, MANTIS_ERROR, 1, "DVB exit failed");
171 if (mantis_i2c_exit(mantis) < 0)
172 dprintk(verbose, MANTIS_ERROR, 1, "I2C adapter delete.. failed");
173
174 return 0;
175}
176
177
178void gpio_set_bits(struct mantis_pci *mantis, u32 bitpos, u8 value)
179{
180 u32 cur;
181
182 cur = mmread(MANTIS_GPIF_ADDR);
183 if (value)
184 mantis->gpio_status = cur | (1 << bitpos);
185 else
186 mantis->gpio_status = cur & (~(1 << bitpos));
187
188 mmwrite(mantis->gpio_status, MANTIS_GPIF_ADDR);
189 mmwrite(0x00, MANTIS_GPIF_DOUT);
190 udelay(100);
191}
192
193
194void mantis_set_direction(struct mantis_pci *mantis, int direction)
195{
196 u32 reg;
197
198 reg = mmread(0x28);
199 dprintk(verbose, MANTIS_DEBUG, 1, "TS direction setup");
200 if (direction == 0x01) {
201
202 reg |= 0x04;
203 mmwrite(reg, 0x28);
204 reg &= 0xff - 0x04;
205 mmwrite(reg, 0x28);
206 } else {
207 reg &= 0xff - 0x04;
208 mmwrite(reg, 0x28);
209 reg |= 0x04;
210 mmwrite(reg, 0x28);
211 }
212}
213
