1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * udbg debug output routine via GELIC UDP broadcasts
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>
11 #include <linux/if_ether.h>
12 #include <linux/etherdevice.h>
13 #include <linux/if_vlan.h>
15 #include <linux/udp.h>
20 #include <asm/lv1call.h>
22 #define GELIC_BUS_ID 1
23 #define GELIC_DEVICE_ID 0
24 #define GELIC_DEBUG_PORT 18194
25 #define GELIC_MAX_MESSAGE_SIZE 1000
27 #define GELIC_LV1_GET_MAC_ADDRESS 1
28 #define GELIC_LV1_GET_VLAN_ID 4
29 #define GELIC_LV1_VLAN_TX_ETHERNET_0 2
31 #define GELIC_DESCR_DMA_STAT_MASK 0xf0000000
32 #define GELIC_DESCR_DMA_CARDOWNED 0xa0000000
34 #define GELIC_DESCR_TX_DMA_IKE 0x00080000
35 #define GELIC_DESCR_TX_DMA_NO_CHKSUM 0x00000000
36 #define GELIC_DESCR_TX_DMA_FRAME_TAIL 0x00040000
38 #define GELIC_DESCR_DMA_CMD_NO_CHKSUM (GELIC_DESCR_DMA_CARDOWNED | \
39 GELIC_DESCR_TX_DMA_IKE | \
40 GELIC_DESCR_TX_DMA_NO_CHKSUM)
45 /* as defined by the hardware */
48 __be32 next_descr_addr;
49 __be32 dmac_cmd_status;
51 __be32 valid_size; /* all zeroes for tx */
53 __be32 data_error; /* all zeroes for tx */
54 } __attribute__((aligned(32)));
57 struct gelic_descr descr;
61 static __iomem struct ethhdr *h_eth;
62 static __iomem struct vlan_hdr *h_vlan;
63 static __iomem struct iphdr *h_ip;
64 static __iomem struct udphdr *h_udp;
66 static __iomem char *pmsg;
67 static __iomem char *pmsgc;
69 static __iomem struct debug_block dbg __attribute__((aligned(32)));
71 static int header_size;
73 static void map_dma_mem(int bus_id, int dev_id, void *start, size_t len,
77 u64 real_addr = ((u64)start) & 0x0fffffffffffffffUL;
78 u64 real_end = real_addr + len;
79 u64 map_start = real_addr & ~0xfff;
80 u64 map_end = (real_end + 0xfff) & ~0xfff;
83 u64 flags = 0xf800000000000000UL;
85 result = lv1_allocate_device_dma_region(bus_id, dev_id,
86 map_end - map_start, 12, 0,
91 result = lv1_map_device_dma_region(bus_id, dev_id, map_start,
92 bus_addr, map_end - map_start,
97 *real_bus_addr = bus_addr + real_addr - map_start;
100 static int unmap_dma_mem(int bus_id, int dev_id, u64 bus_addr, size_t len)
105 real_bus_addr = bus_addr & ~0xfff;
106 len += bus_addr - real_bus_addr;
107 len = (len + 0xfff) & ~0xfff;
109 result = lv1_unmap_device_dma_region(bus_id, dev_id, real_bus_addr,
114 return lv1_free_device_dma_region(bus_id, dev_id, real_bus_addr);
117 static void __init gelic_debug_init(void)
124 result = lv1_open_device(GELIC_BUS_ID, GELIC_DEVICE_ID, 0);
128 map_dma_mem(GELIC_BUS_ID, GELIC_DEVICE_ID, &dbg, sizeof(dbg),
131 memset(&dbg, 0, sizeof(dbg));
133 dbg.descr.buf_addr = bus_addr + offsetof(struct debug_block, pkt);
137 result = lv1_net_control(GELIC_BUS_ID, GELIC_DEVICE_ID,
138 GELIC_LV1_GET_MAC_ADDRESS, 0, 0, 0,
145 h_eth = (struct ethhdr *)dbg.pkt;
147 eth_broadcast_addr(h_eth->h_dest);
148 memcpy(&h_eth->h_source, &mac, ETH_ALEN);
150 header_size = sizeof(struct ethhdr);
152 result = lv1_net_control(GELIC_BUS_ID, GELIC_DEVICE_ID,
153 GELIC_LV1_GET_VLAN_ID,
154 GELIC_LV1_VLAN_TX_ETHERNET_0, 0, 0,
157 h_eth->h_proto= ETH_P_8021Q;
159 header_size += sizeof(struct vlan_hdr);
160 h_vlan = (struct vlan_hdr *)(h_eth + 1);
161 h_vlan->h_vlan_TCI = vlan_id;
162 h_vlan->h_vlan_encapsulated_proto = ETH_P_IP;
163 h_ip = (struct iphdr *)(h_vlan + 1);
165 h_eth->h_proto= 0x0800;
166 h_ip = (struct iphdr *)(h_eth + 1);
169 header_size += sizeof(struct iphdr);
173 h_ip->protocol = 0x11;
174 h_ip->saddr = 0x00000000;
175 h_ip->daddr = 0xffffffff;
177 header_size += sizeof(struct udphdr);
178 h_udp = (struct udphdr *)(h_ip + 1);
179 h_udp->source = GELIC_DEBUG_PORT;
180 h_udp->dest = GELIC_DEBUG_PORT;
182 pmsgc = pmsg = (char *)(h_udp + 1);
185 static void gelic_debug_shutdown(void)
188 unmap_dma_mem(GELIC_BUS_ID, GELIC_DEVICE_ID,
189 bus_addr, sizeof(dbg));
190 lv1_close_device(GELIC_BUS_ID, GELIC_DEVICE_ID);
193 static void gelic_sendbuf(int msgsize)
199 dbg.descr.buf_size = header_size + msgsize;
200 h_ip->tot_len = msgsize + sizeof(struct udphdr) +
201 sizeof(struct iphdr);
202 h_udp->len = msgsize + sizeof(struct udphdr);
207 for (i = 0; i < 5; i++)
209 h_ip->check = ~(sum + (sum >> 16));
211 dbg.descr.dmac_cmd_status = GELIC_DESCR_DMA_CMD_NO_CHKSUM |
212 GELIC_DESCR_TX_DMA_FRAME_TAIL;
213 dbg.descr.result_size = 0;
214 dbg.descr.data_status = 0;
218 lv1_net_start_tx_dma(GELIC_BUS_ID, GELIC_DEVICE_ID, bus_addr, 0);
220 while ((dbg.descr.dmac_cmd_status & GELIC_DESCR_DMA_STAT_MASK) ==
221 GELIC_DESCR_DMA_CARDOWNED)
225 static void ps3gelic_udbg_putc(char ch)
228 if (ch == '\n' || (pmsgc-pmsg) >= GELIC_MAX_MESSAGE_SIZE) {
229 gelic_sendbuf(pmsgc-pmsg);
234 void __init udbg_init_ps3gelic(void)
237 udbg_putc = ps3gelic_udbg_putc;
240 void udbg_shutdown_ps3gelic(void)
243 gelic_debug_shutdown();
245 EXPORT_SYMBOL(udbg_shutdown_ps3gelic);