1 /*
2 * udbg debug output routine via GELIC UDP broadcasts
3 *
4 * Copyright (C) 2007 Sony Computer Entertainment Inc.
5 * Copyright 2006, 2007 Sony Corporation
6 * Copyright (C) 2010 Hector Martin <hector@marcansoft.com>
7 * Copyright (C) 2011 Andre Heider <a.heider@gmail.com>
8 *
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License
11 * as published by the Free Software Foundation; either version 2
12 * of the License, or (at your option) any later version.
13 *
14 */
15
16 #include <asm/io.h>
17 #include <asm/udbg.h>
18 #include <asm/lv1call.h>
19
20 #define GELIC_BUS_ID 1
21 #define GELIC_DEVICE_ID 0
22 #define GELIC_DEBUG_PORT 18194
23 #define GELIC_MAX_MESSAGE_SIZE 1000
24
25 #define GELIC_LV1_GET_MAC_ADDRESS 1
26 #define GELIC_LV1_GET_VLAN_ID 4
27 #define GELIC_LV1_VLAN_TX_ETHERNET_0 2
28
29 #define GELIC_DESCR_DMA_STAT_MASK 0xf0000000
30 #define GELIC_DESCR_DMA_CARDOWNED 0xa0000000
31
32 #define GELIC_DESCR_TX_DMA_IKE 0x00080000
33 #define GELIC_DESCR_TX_DMA_NO_CHKSUM 0x00000000
34 #define GELIC_DESCR_TX_DMA_FRAME_TAIL 0x00040000
35
36 #define GELIC_DESCR_DMA_CMD_NO_CHKSUM (GELIC_DESCR_DMA_CARDOWNED | \
37 GELIC_DESCR_TX_DMA_IKE | \
38 GELIC_DESCR_TX_DMA_NO_CHKSUM)
39
40 static u64 bus_addr;
41
42 struct gelic_descr {
43 /* as defined by the hardware */
44 __be32 buf_addr;
45 __be32 buf_size;
46 __be32 next_descr_addr;
47 __be32 dmac_cmd_status;
48 __be32 result_size;
49 __be32 valid_size; /* all zeroes for tx */
50 __be32 data_status;
51 __be32 data_error; /* all zeroes for tx */
52 } __attribute__((aligned(32)));
53
54 struct debug_block {
55 struct gelic_descr descr;
56 u8 pkt[1520];
57 } __packed;
58
59 struct ethhdr {
60 u8 dest[6];
61 u8 src[6];
62 u16 type;
63 } __packed;
64
65 struct vlantag {
66 u16 vlan;
67 u16 subtype;
68 } __packed;
69
70 struct iphdr {
71 u8 ver_len;
72 u8 dscp_ecn;
73 u16 total_length;
74 u16 ident;
75 u16 frag_off_flags;
76 u8 ttl;
77 u8 proto;
78 u16 checksum;
79 u32 src;
80 u32 dest;
81 } __packed;
82
83 struct udphdr {
84 u16 src;
85 u16 dest;
86 u16 len;
87 u16 checksum;
88 } __packed;
89
90 static __iomem struct ethhdr *h_eth;
91 static __iomem struct vlantag *h_vlan;
92 static __iomem struct iphdr *h_ip;
93 static __iomem struct udphdr *h_udp;
94
95 static __iomem char *pmsg;
96 static __iomem char *pmsgc;
97
98 static __iomem struct debug_block dbg __attribute__((aligned(32)));
99
100 static int header_size;
101
map_dma_mem(int bus_id,int dev_id,void * start,size_t len,u64 * real_bus_addr)102 static void map_dma_mem(int bus_id, int dev_id, void *start, size_t len,
103 u64 *real_bus_addr)
104 {
105 s64 result;
106 u64 real_addr = ((u64)start) & 0x0fffffffffffffffUL;
107 u64 real_end = real_addr + len;
108 u64 map_start = real_addr & ~0xfff;
109 u64 map_end = (real_end + 0xfff) & ~0xfff;
110 u64 bus_addr = 0;
111
112 u64 flags = 0xf800000000000000UL;
113
114 result = lv1_allocate_device_dma_region(bus_id, dev_id,
115 map_end - map_start, 12, 0,
116 &bus_addr);
117 if (result)
118 lv1_panic(0);
119
120 result = lv1_map_device_dma_region(bus_id, dev_id, map_start,
121 bus_addr, map_end - map_start,
122 flags);
123 if (result)
124 lv1_panic(0);
125
126 *real_bus_addr = bus_addr + real_addr - map_start;
127 }
128
unmap_dma_mem(int bus_id,int dev_id,u64 bus_addr,size_t len)129 static int unmap_dma_mem(int bus_id, int dev_id, u64 bus_addr, size_t len)
130 {
131 s64 result;
132 u64 real_bus_addr;
133
134 real_bus_addr = bus_addr & ~0xfff;
135 len += bus_addr - real_bus_addr;
136 len = (len + 0xfff) & ~0xfff;
137
138 result = lv1_unmap_device_dma_region(bus_id, dev_id, real_bus_addr,
139 len);
140 if (result)
141 return result;
142
143 return lv1_free_device_dma_region(bus_id, dev_id, real_bus_addr);
144 }
145
gelic_debug_init(void)146 static void gelic_debug_init(void)
147 {
148 s64 result;
149 u64 v2;
150 u64 mac;
151 u64 vlan_id;
152
153 result = lv1_open_device(GELIC_BUS_ID, GELIC_DEVICE_ID, 0);
154 if (result)
155 lv1_panic(0);
156
157 map_dma_mem(GELIC_BUS_ID, GELIC_DEVICE_ID, &dbg, sizeof(dbg),
158 &bus_addr);
159
160 memset(&dbg, 0, sizeof(dbg));
161
162 dbg.descr.buf_addr = bus_addr + offsetof(struct debug_block, pkt);
163
164 wmb();
165
166 result = lv1_net_control(GELIC_BUS_ID, GELIC_DEVICE_ID,
167 GELIC_LV1_GET_MAC_ADDRESS, 0, 0, 0,
168 &mac, &v2);
169 if (result)
170 lv1_panic(0);
171
172 mac <<= 16;
173
174 h_eth = (struct ethhdr *)dbg.pkt;
175
176 memset(&h_eth->dest, 0xff, 6);
177 memcpy(&h_eth->src, &mac, 6);
178
179 header_size = sizeof(struct ethhdr);
180
181 result = lv1_net_control(GELIC_BUS_ID, GELIC_DEVICE_ID,
182 GELIC_LV1_GET_VLAN_ID,
183 GELIC_LV1_VLAN_TX_ETHERNET_0, 0, 0,
184 &vlan_id, &v2);
185 if (!result) {
186 h_eth->type = 0x8100;
187
188 header_size += sizeof(struct vlantag);
189 h_vlan = (struct vlantag *)(h_eth + 1);
190 h_vlan->vlan = vlan_id;
191 h_vlan->subtype = 0x0800;
192 h_ip = (struct iphdr *)(h_vlan + 1);
193 } else {
194 h_eth->type = 0x0800;
195 h_ip = (struct iphdr *)(h_eth + 1);
196 }
197
198 header_size += sizeof(struct iphdr);
199 h_ip->ver_len = 0x45;
200 h_ip->ttl = 10;
201 h_ip->proto = 0x11;
202 h_ip->src = 0x00000000;
203 h_ip->dest = 0xffffffff;
204
205 header_size += sizeof(struct udphdr);
206 h_udp = (struct udphdr *)(h_ip + 1);
207 h_udp->src = GELIC_DEBUG_PORT;
208 h_udp->dest = GELIC_DEBUG_PORT;
209
210 pmsgc = pmsg = (char *)(h_udp + 1);
211 }
212
gelic_debug_shutdown(void)213 static void gelic_debug_shutdown(void)
214 {
215 if (bus_addr)
216 unmap_dma_mem(GELIC_BUS_ID, GELIC_DEVICE_ID,
217 bus_addr, sizeof(dbg));
218 lv1_close_device(GELIC_BUS_ID, GELIC_DEVICE_ID);
219 }
220
gelic_sendbuf(int msgsize)221 static void gelic_sendbuf(int msgsize)
222 {
223 u16 *p;
224 u32 sum;
225 int i;
226
227 dbg.descr.buf_size = header_size + msgsize;
228 h_ip->total_length = msgsize + sizeof(struct udphdr) +
229 sizeof(struct iphdr);
230 h_udp->len = msgsize + sizeof(struct udphdr);
231
232 h_ip->checksum = 0;
233 sum = 0;
234 p = (u16 *)h_ip;
235 for (i = 0; i < 5; i++)
236 sum += *p++;
237 h_ip->checksum = ~(sum + (sum >> 16));
238
239 dbg.descr.dmac_cmd_status = GELIC_DESCR_DMA_CMD_NO_CHKSUM |
240 GELIC_DESCR_TX_DMA_FRAME_TAIL;
241 dbg.descr.result_size = 0;
242 dbg.descr.data_status = 0;
243
244 wmb();
245
246 lv1_net_start_tx_dma(GELIC_BUS_ID, GELIC_DEVICE_ID, bus_addr, 0);
247
248 while ((dbg.descr.dmac_cmd_status & GELIC_DESCR_DMA_STAT_MASK) ==
249 GELIC_DESCR_DMA_CARDOWNED)
250 cpu_relax();
251 }
252
ps3gelic_udbg_putc(char ch)253 static void ps3gelic_udbg_putc(char ch)
254 {
255 *pmsgc++ = ch;
256 if (ch == '\n' || (pmsgc-pmsg) >= GELIC_MAX_MESSAGE_SIZE) {
257 gelic_sendbuf(pmsgc-pmsg);
258 pmsgc = pmsg;
259 }
260 }
261
udbg_init_ps3gelic(void)262 void __init udbg_init_ps3gelic(void)
263 {
264 gelic_debug_init();
265 udbg_putc = ps3gelic_udbg_putc;
266 }
267
udbg_shutdown_ps3gelic(void)268 void udbg_shutdown_ps3gelic(void)
269 {
270 udbg_putc = NULL;
271 gelic_debug_shutdown();
272 }
273 EXPORT_SYMBOL(udbg_shutdown_ps3gelic);
274