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 header_size;
71 
map_dma_mem(int bus_id,int dev_id,void * start,size_t len,u64 * real_bus_addr)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 
unmap_dma_mem(int bus_id,int dev_id,u64 bus_addr,size_t len)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 
gelic_debug_init(void)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 
146 	eth_broadcast_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 
gelic_debug_shutdown(void)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 
gelic_sendbuf(int msgsize)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 
ps3gelic_udbg_putc(char ch)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 
udbg_init_ps3gelic(void)233 void __init udbg_init_ps3gelic(void)
234 {
235 	gelic_debug_init();
236 	udbg_putc = ps3gelic_udbg_putc;
237 }
238 
udbg_shutdown_ps3gelic(void)239 void udbg_shutdown_ps3gelic(void)
240 {
241 	udbg_putc = NULL;
242 	gelic_debug_shutdown();
243 }
244 EXPORT_SYMBOL(udbg_shutdown_ps3gelic);
245