]>
Commit | Line | Data |
---|---|---|
2874c5fd | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
c26afe9e HM |
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> | |
c26afe9e HM |
9 | */ |
10 | ||
497abcf6 LH |
11 | #include <linux/if_ether.h> |
12 | #include <linux/etherdevice.h> | |
e9aaa6d1 | 13 | #include <linux/if_vlan.h> |
0336c8cd | 14 | #include <linux/ip.h> |
95442c64 | 15 | #include <linux/udp.h> |
497abcf6 | 16 | |
c26afe9e HM |
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 | ||
c26afe9e | 60 | static __iomem struct ethhdr *h_eth; |
e9aaa6d1 | 61 | static __iomem struct vlan_hdr *h_vlan; |
c26afe9e HM |
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 header_size; | |
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 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, &dbg, sizeof(dbg), | |
128 | &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 | ||
497abcf6 LH |
146 | eth_broadcast_addr(h_eth->h_dest); |
147 | memcpy(&h_eth->h_source, &mac, ETH_ALEN); | |
c26afe9e HM |
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) { | |
497abcf6 | 156 | h_eth->h_proto= ETH_P_8021Q; |
c26afe9e | 157 | |
e9aaa6d1 LH |
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; | |
c26afe9e HM |
162 | h_ip = (struct iphdr *)(h_vlan + 1); |
163 | } else { | |
497abcf6 | 164 | h_eth->h_proto= 0x0800; |
c26afe9e HM |
165 | h_ip = (struct iphdr *)(h_eth + 1); |
166 | } | |
167 | ||
168 | header_size += sizeof(struct iphdr); | |
0336c8cd LH |
169 | h_ip->version = 4; |
170 | h_ip->ihl = 5; | |
c26afe9e | 171 | h_ip->ttl = 10; |
0336c8cd LH |
172 | h_ip->protocol = 0x11; |
173 | h_ip->saddr = 0x00000000; | |
174 | h_ip->daddr = 0xffffffff; | |
c26afe9e HM |
175 | |
176 | header_size += sizeof(struct udphdr); | |
177 | h_udp = (struct udphdr *)(h_ip + 1); | |
95442c64 | 178 | h_udp->source = GELIC_DEBUG_PORT; |
c26afe9e HM |
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, 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; | |
0336c8cd | 199 | h_ip->tot_len = msgsize + sizeof(struct udphdr) + |
c26afe9e HM |
200 | sizeof(struct iphdr); |
201 | h_udp->len = msgsize + sizeof(struct udphdr); | |
202 | ||
0336c8cd | 203 | h_ip->check = 0; |
c26afe9e HM |
204 | sum = 0; |
205 | p = (u16 *)h_ip; | |
206 | for (i = 0; i < 5; i++) | |
207 | sum += *p++; | |
0336c8cd | 208 | h_ip->check = ~(sum + (sum >> 16)); |
c26afe9e HM |
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(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); |