Gitiles
Code Review Sign In
gerrit-public.fairphone.software / fp2-dev / kernel / msm / bff06d552240ba7f5b49482a4865871d7bc03dc2 / . / arch / sparc64 / prom / p1275.c
blob: a5a7c5712028b2b3401d908baa3b739ca2e0117c [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]1/* $Id: p1275.c,v 1.22 2001/10/18 09:40:00 davem Exp $
2 * p1275.c: Sun IEEE 1275 PROM low level interface routines
3 *
4 * Copyright (C) 1996,1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
5 */
6
7#include <linux/kernel.h>
8#include <linux/init.h>
9#include <linux/sched.h>
10#include <linux/smp.h>
11#include <linux/string.h>
12#include <linux/spinlock.h>
13
14#include <asm/openprom.h>
15#include <asm/oplib.h>
16#include <asm/system.h>
17#include <asm/spitfire.h>
18#include <asm/pstate.h>
19
20struct {
21 long prom_callback; /* 0x00 */
22 void (*prom_cif_handler)(long *); /* 0x08 */
23 unsigned long prom_cif_stack; /* 0x10 */
24 unsigned long prom_args [23]; /* 0x18 */
25 char prom_buffer [3000];
26} p1275buf;
27
28extern void prom_world(int);
29
30extern void prom_cif_interface(void);
31extern void prom_cif_callback(void);
32
33static inline unsigned long spitfire_get_primary_context(void)
34{
35 unsigned long ctx;
36
37 __asm__ __volatile__("ldxa [%1] %2, %0"
38 : "=r" (ctx)
39 : "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
40 return ctx;
41}
42
43/*
44 * This provides SMP safety on the p1275buf. prom_callback() drops this lock
45 * to allow recursuve acquisition.
46 */
47DEFINE_SPINLOCK(prom_entry_lock);
48
David S. Millerbff06d52005-09-22 20:11:33 -0700[diff] [blame^]49long p1275_cmd(const char *service, long fmt, ...)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]50{
51 char *p, *q;
52 unsigned long flags;
53 int nargs, nrets, i;
54 va_list list;
55 long attrs, x;
56
57 p = p1275buf.prom_buffer;
58 BUG_ON((spitfire_get_primary_context() & CTX_NR_MASK) != 0);
59
60 spin_lock_irqsave(&prom_entry_lock, flags);
61
62 p1275buf.prom_args[0] = (unsigned long)p; /* service */
63 strcpy (p, service);
64 p = (char *)(((long)(strchr (p, 0) + 8)) & ~7);
65 p1275buf.prom_args[1] = nargs = (fmt & 0x0f); /* nargs */
66 p1275buf.prom_args[2] = nrets = ((fmt & 0xf0) >> 4); /* nrets */
67 attrs = fmt >> 8;
68 va_start(list, fmt);
69 for (i = 0; i < nargs; i++, attrs >>= 3) {
70 switch (attrs & 0x7) {
71 case P1275_ARG_NUMBER:
72 p1275buf.prom_args[i + 3] =
73 (unsigned)va_arg(list, long);
74 break;
75 case P1275_ARG_IN_64B:
76 p1275buf.prom_args[i + 3] =
77 va_arg(list, unsigned long);
78 break;
79 case P1275_ARG_IN_STRING:
80 strcpy (p, va_arg(list, char *));
81 p1275buf.prom_args[i + 3] = (unsigned long)p;
82 p = (char *)(((long)(strchr (p, 0) + 8)) & ~7);
83 break;
84 case P1275_ARG_OUT_BUF:
85 (void) va_arg(list, char *);
86 p1275buf.prom_args[i + 3] = (unsigned long)p;
87 x = va_arg(list, long);
88 i++; attrs >>= 3;
89 p = (char *)(((long)(p + (int)x + 7)) & ~7);
90 p1275buf.prom_args[i + 3] = x;
91 break;
92 case P1275_ARG_IN_BUF:
93 q = va_arg(list, char *);
94 p1275buf.prom_args[i + 3] = (unsigned long)p;
95 x = va_arg(list, long);
96 i++; attrs >>= 3;
97 memcpy (p, q, (int)x);
98 p = (char *)(((long)(p + (int)x + 7)) & ~7);
99 p1275buf.prom_args[i + 3] = x;
100 break;
101 case P1275_ARG_OUT_32B:
102 (void) va_arg(list, char *);
103 p1275buf.prom_args[i + 3] = (unsigned long)p;
104 p += 32;
105 break;
106 case P1275_ARG_IN_FUNCTION:
107 p1275buf.prom_args[i + 3] =
108 (unsigned long)prom_cif_callback;
109 p1275buf.prom_callback = va_arg(list, long);
110 break;
111 }
112 }
113 va_end(list);
114
115 prom_world(1);
116 prom_cif_interface();
117 prom_world(0);
118
119 attrs = fmt >> 8;
120 va_start(list, fmt);
121 for (i = 0; i < nargs; i++, attrs >>= 3) {
122 switch (attrs & 0x7) {
123 case P1275_ARG_NUMBER:
124 (void) va_arg(list, long);
125 break;
126 case P1275_ARG_IN_STRING:
127 (void) va_arg(list, char *);
128 break;
129 case P1275_ARG_IN_FUNCTION:
130 (void) va_arg(list, long);
131 break;
132 case P1275_ARG_IN_BUF:
133 (void) va_arg(list, char *);
134 (void) va_arg(list, long);
135 i++; attrs >>= 3;
136 break;
137 case P1275_ARG_OUT_BUF:
138 p = va_arg(list, char *);
139 x = va_arg(list, long);
140 memcpy (p, (char *)(p1275buf.prom_args[i + 3]), (int)x);
141 i++; attrs >>= 3;
142 break;
143 case P1275_ARG_OUT_32B:
144 p = va_arg(list, char *);
145 memcpy (p, (char *)(p1275buf.prom_args[i + 3]), 32);
146 break;
147 }
148 }
149 va_end(list);
150 x = p1275buf.prom_args [nargs + 3];
151
152 spin_unlock_irqrestore(&prom_entry_lock, flags);
153
154 return x;
155}
156
157void prom_cif_init(void *cif_handler, void *cif_stack)
158{
159 p1275buf.prom_cif_handler = (void (*)(long *))cif_handler;
160 p1275buf.prom_cif_stack = (unsigned long)cif_stack;
161}