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