Skip to content
Projects
Groups
Snippets
Help
Loading...
Help
Support
Keyboard shortcuts
?
Submit feedback
Contribute to GitLab
Sign in / Register
Toggle navigation
L
linux
Project overview
Project overview
Details
Activity
Releases
Repository
Repository
Files
Commits
Branches
Tags
Contributors
Graph
Compare
Issues
0
Issues
0
List
Boards
Labels
Milestones
Merge Requests
0
Merge Requests
0
Analytics
Analytics
Repository
Value Stream
Wiki
Wiki
Snippets
Snippets
Members
Members
Collapse sidebar
Close sidebar
Activity
Graph
Create a new issue
Commits
Issue Boards
Open sidebar
nexedi
linux
Commits
130ca59d
Commit
130ca59d
authored
Aug 03, 2002
by
Linus Torvalds
Browse files
Options
Browse Files
Download
Plain Diff
Merge
http://gkernel.bkbits.net/misc-2.5
into home.transmeta.com:/home/torvalds/v2.5/linux
parents
c3b26786
0b520647
Changes
14
Hide whitespace changes
Inline
Side-by-side
Showing
14 changed files
with
938 additions
and
2430 deletions
+938
-2430
arch/sparc64/kernel/devices.c
arch/sparc64/kernel/devices.c
+6
-0
arch/sparc64/kernel/smp.c
arch/sparc64/kernel/smp.c
+77
-88
arch/sparc64/kernel/sparc64_ksyms.c
arch/sparc64/kernel/sparc64_ksyms.c
+4
-0
arch/sparc64/solaris/systbl.S
arch/sparc64/solaris/systbl.S
+2
-2
drivers/net/myri_sbus.c
drivers/net/myri_sbus.c
+8
-2
drivers/net/myri_sbus.h
drivers/net/myri_sbus.h
+1
-0
drivers/sbus/char/openprom.c
drivers/sbus/char/openprom.c
+0
-27
drivers/scsi/qlogicpti.c
drivers/scsi/qlogicpti.c
+21
-19
drivers/serial/sunsab.c
drivers/serial/sunsab.c
+767
-2213
drivers/serial/sunsab.h
drivers/serial/sunsab.h
+4
-63
drivers/serial/sunsu.c
drivers/serial/sunsu.c
+16
-5
drivers/serial/sunzilog.c
drivers/serial/sunzilog.c
+20
-9
include/asm-sparc64/ns87303.h
include/asm-sparc64/ns87303.h
+8
-2
include/linux/serial_core.h
include/linux/serial_core.h
+4
-0
No files found.
arch/sparc64/kernel/devices.c
View file @
130ca59d
...
...
@@ -10,6 +10,7 @@
#include <linux/init.h>
#include <linux/ioport.h>
#include <linux/string.h>
#include <linux/spinlock.h>
#include <asm/page.h>
#include <asm/oplib.h>
...
...
@@ -17,6 +18,11 @@
#include <asm/smp.h>
#include <asm/spitfire.h>
/* Used to synchronize acceses to NatSemi SUPER I/O chip configure
* operations in asm/ns87303.h
*/
spinlock_t
ns87303_lock
=
SPIN_LOCK_UNLOCKED
;
struct
prom_cpuinfo
linux_cpus
[
NR_CPUS
]
__initdata
=
{
{
0
}
};
unsigned
prom_cpu_nodes
[
NR_CPUS
];
int
linux_num_cpus
=
0
;
...
...
arch/sparc64/kernel/smp.c
View file @
130ca59d
...
...
@@ -45,7 +45,6 @@ cpuinfo_sparc cpu_data[NR_CPUS];
/* Please don't make this stuff initdata!!! --DaveM */
static
unsigned
char
boot_cpu_id
;
static
int
smp_activated
;
/* Kernel spinlock */
spinlock_t
kernel_flag
__cacheline_aligned_in_smp
=
SPIN_LOCK_UNLOCKED
;
...
...
@@ -223,85 +222,46 @@ extern unsigned long sparc64_cpu_startup;
*/
static
struct
thread_info
*
cpu_new_thread
=
NULL
;
static
void
__init
smp_boot_cpus
(
unsigned
int
max_cpus
)
static
int
__devinit
smp_boot_one_cpu
(
unsigned
int
cpu
)
{
int
cpucount
=
0
,
i
;
unsigned
long
entry
=
(
unsigned
long
)(
&
sparc64_cpu_startup
);
unsigned
long
cookie
=
(
unsigned
long
)(
&
cpu_new_thread
);
struct
task_struct
*
p
;
int
timeout
,
no
,
ret
;
printk
(
"Entering UltraSMPenguin Mode...
\n
"
);
local_irq_enable
();
smp_store_cpu_info
(
boot_cpu_id
);
if
(
linux_num_cpus
==
1
)
return
;
for
(
i
=
0
;
i
<
NR_CPUS
;
i
++
)
{
if
(
i
==
boot_cpu_id
)
continue
;
if
((
cpucount
+
1
)
==
max_cpus
)
goto
ignorecpu
;
if
(
test_bit
(
i
,
&
phys_cpu_present_map
))
{
unsigned
long
entry
=
(
unsigned
long
)(
&
sparc64_cpu_startup
);
unsigned
long
cookie
=
(
unsigned
long
)(
&
cpu_new_thread
);
struct
task_struct
*
p
;
int
timeout
;
int
no
;
kernel_thread
(
NULL
,
NULL
,
CLONE_IDLETASK
);
prom_printf
(
"Starting CPU %d... "
,
i
);
kernel_thread
(
NULL
,
NULL
,
CLONE_IDLETASK
);
cpucount
++
;
p
=
prev_task
(
&
init_task
);
p
=
prev_task
(
&
init_task
);
init_idle
(
p
,
cpu
);
init_idle
(
p
,
i
);
unhash_process
(
p
);
unhash_process
(
p
);
callin_flag
=
0
;
for
(
no
=
0
;
no
<
linux_num_cpus
;
no
++
)
if
(
linux_cpus
[
no
].
mid
==
i
)
break
;
cpu_new_thread
=
p
->
thread_info
;
set_bit
(
i
,
&
cpu_callout_map
);
prom_startcpu
(
linux_cpus
[
no
].
prom_node
,
entry
,
cookie
);
for
(
timeout
=
0
;
timeout
<
5000000
;
timeout
++
)
{
if
(
callin_flag
)
break
;
udelay
(
100
);
}
if
(
callin_flag
)
{
prom_cpu_nodes
[
i
]
=
linux_cpus
[
no
].
prom_node
;
prom_printf
(
"OK
\n
"
);
}
else
{
cpucount
--
;
printk
(
"Processor %d is stuck.
\n
"
,
i
);
prom_printf
(
"FAILED
\n
"
);
clear_bit
(
i
,
&
cpu_callout_map
);
}
ignorecpu:
}
callin_flag
=
0
;
for
(
no
=
0
;
no
<
linux_num_cpus
;
no
++
)
if
(
linux_cpus
[
no
].
mid
==
cpu
)
break
;
cpu_new_thread
=
p
->
thread_info
;
set_bit
(
cpu
,
&
cpu_callout_map
);
prom_startcpu
(
linux_cpus
[
no
].
prom_node
,
entry
,
cookie
);
for
(
timeout
=
0
;
timeout
<
5000000
;
timeout
++
)
{
if
(
callin_flag
)
break
;
udelay
(
100
);
}
cpu_new_thread
=
NULL
;
if
(
cpucount
==
0
)
{
if
(
max_cpus
!=
1
)
printk
(
"Error: only one processor found.
\n
"
);
if
(
callin_flag
)
{
prom_cpu_nodes
[
cpu
]
=
linux_cpus
[
no
].
prom_node
;
ret
=
0
;
}
else
{
unsigned
long
bogosum
=
0
;
for
(
i
=
0
;
i
<
NR_CPUS
;
i
++
)
{
if
(
cpu_online
(
i
))
bogosum
+=
cpu_data
[
i
].
udelay_val
;
}
printk
(
"Total of %d processors activated "
"(%lu.%02lu BogoMIPS).
\n
"
,
cpucount
+
1
,
bogosum
/
(
500000
/
HZ
),
(
bogosum
/
(
5000
/
HZ
))
%
100
);
smp_activated
=
1
;
printk
(
"Processor %d is stuck.
\n
"
,
cpu
);
clear_bit
(
cpu
,
&
cpu_callout_map
);
ret
=
-
ENODEV
;
}
cpu_new_thread
=
NULL
;
return
ret
;
}
static
void
spitfire_xcall_helper
(
u64
data0
,
u64
data1
,
u64
data2
,
u64
pstate
,
unsigned
long
cpu
)
...
...
@@ -1119,8 +1079,6 @@ static void __init smp_setup_percpu_timer(void)
void
__init
smp_tick_init
(
void
)
{
int
i
;
boot_cpu_id
=
hard_smp_processor_id
();
current_tick_offset
=
timer_tick_offset
;
...
...
@@ -1129,19 +1087,10 @@ void __init smp_tick_init(void)
prom_halt
();
}
atomic_set
(
&
sparc64_num_cpus_online
,
1
);
memset
(
&
cpu_online_map
,
0
,
sizeof
(
cpu_online_map
));
atomic_inc
(
&
sparc64_num_cpus_online
);
set_bit
(
boot_cpu_id
,
&
cpu_online_map
);
prom_cpu_nodes
[
boot_cpu_id
]
=
linux_cpus
[
0
].
prom_node
;
prof_counter
(
boot_cpu_id
)
=
prof_multiplier
(
boot_cpu_id
)
=
1
;
for
(
i
=
0
;
i
<
linux_num_cpus
;
i
++
)
{
if
(
linux_cpus
[
i
].
mid
<
NR_CPUS
)
{
set_bit
(
linux_cpus
[
i
].
mid
,
&
phys_cpu_present_map
);
atomic_inc
(
&
sparc64_num_cpus_possible
);
}
}
}
cycles_t
cacheflush_time
;
...
...
@@ -1272,19 +1221,59 @@ int setup_profiling_timer(unsigned int multiplier)
void
__init
smp_prepare_cpus
(
unsigned
int
max_cpus
)
{
smp_boot_cpus
(
max_cpus
);
int
i
;
for
(
i
=
0
;
i
<
linux_num_cpus
;
i
++
)
{
if
(
linux_cpus
[
i
].
mid
<
max_cpus
)
{
set_bit
(
linux_cpus
[
i
].
mid
,
&
phys_cpu_present_map
);
atomic_inc
(
&
sparc64_num_cpus_possible
);
}
}
if
(
atomic_read
(
&
sparc64_num_cpus_possible
)
>
max_cpus
)
{
for
(
i
=
linux_num_cpus
-
1
;
i
>=
0
;
i
--
)
{
if
(
linux_cpus
[
i
].
mid
!=
boot_cpu_id
)
{
clear_bit
(
linux_cpus
[
i
].
mid
,
&
phys_cpu_present_map
);
atomic_dec
(
&
sparc64_num_cpus_possible
);
if
(
atomic_read
(
&
sparc64_num_cpus_possible
)
<=
max_cpus
)
break
;
}
}
}
smp_store_cpu_info
(
boot_cpu_id
);
}
int
__devinit
__cpu_up
(
unsigned
int
cpu
)
{
set_bit
(
cpu
,
&
smp_commenced_mask
);
while
(
!
test_bit
(
cpu
,
&
cpu_online_map
))
mb
();
return
0
;
int
ret
=
smp_boot_one_cpu
(
cpu
);
if
(
!
ret
)
{
set_bit
(
cpu
,
&
smp_commenced_mask
);
while
(
!
test_bit
(
cpu
,
&
cpu_online_map
))
mb
();
if
(
!
test_bit
(
cpu
,
&
cpu_online_map
))
ret
=
-
ENODEV
;
}
return
ret
;
}
void
__init
smp_cpus_done
(
unsigned
int
max_cpus
)
{
unsigned
long
bogosum
=
0
;
int
i
;
for
(
i
=
0
;
i
<
NR_CPUS
;
i
++
)
{
if
(
cpu_online
(
i
))
bogosum
+=
cpu_data
[
i
].
udelay_val
;
}
printk
(
"Total of %d processors activated "
"(%lu.%02lu BogoMIPS).
\n
"
,
num_online_cpus
(),
bogosum
/
(
500000
/
HZ
),
(
bogosum
/
(
5000
/
HZ
))
%
100
);
/* We want to run this with all the other cpus spinning
* in the kernel.
*/
...
...
arch/sparc64/kernel/sparc64_ksyms.c
View file @
130ca59d
...
...
@@ -52,6 +52,7 @@
#include <asm/isa.h>
#endif
#include <asm/a.out.h>
#include <asm/ns87303.h>
struct
poll
{
int
fd
;
...
...
@@ -373,3 +374,6 @@ EXPORT_SYMBOL(kbd_pt_regs);
#ifdef CONFIG_DEBUG_BUGVERBOSE
EXPORT_SYMBOL
(
do_BUG
);
#endif
/* for ns8703 */
EXPORT_SYMBOL
(
ns87303_lock
);
arch/sparc64/solaris/systbl.S
View file @
130ca59d
...
...
@@ -250,8 +250,8 @@ solaris_sys_table:
.
word
solaris_fstatvfs64
/*
fstatvfs64
dP
219
*/
.
word
solaris_setrlimit64
/*
setrlimit64
dP
220
*/
.
word
solaris_getrlimit64
/*
getrlimit64
dP
221
*/
.
word
CHAIN
(
pread
)
/*
pread64
dpdD
222
*/
.
word
CHAIN
(
pwrite
)
/*
pwrite64
dpdD
223
*/
.
word
CHAIN
(
pread
64
)
/*
pread64
dpdD
222
*/
.
word
CHAIN
(
pwrite
64
)
/*
pwrite64
dpdD
223
*/
.
word
CHAIN
(
creat
)
/*
creat64
so
224
*/
.
word
solaris_open
/*
open64
soo
225
*/
.
word
solaris_unimplemented
/*
226
*/
...
...
drivers/net/myri_sbus.c
View file @
130ca59d
...
...
@@ -546,8 +546,11 @@ static void myri_interrupt(int irq, void *dev_id, struct pt_regs *regs)
struct
myri_eth
*
mp
=
(
struct
myri_eth
*
)
dev
->
priv
;
unsigned
long
lregs
=
mp
->
lregs
;
struct
myri_channel
*
chan
=
&
mp
->
shmem
->
channel
;
unsigned
long
flags
;
u32
status
;
spin_lock_irqsave
(
&
mp
->
irq_lock
,
flags
);
status
=
sbus_readl
(
lregs
+
LANAI_ISTAT
);
DIRQ
((
"myri_interrupt: status[%08x] "
,
status
));
if
(
status
&
ISTAT_HOST
)
{
...
...
@@ -569,6 +572,8 @@ static void myri_interrupt(int irq, void *dev_id, struct pt_regs *regs)
myri_enable_irq
(
lregs
,
mp
->
cregs
);
}
DIRQ
((
"
\n
"
));
spin_unlock_irqrestore
(
&
mp
->
irq_lock
,
flags
);
}
static
int
myri_open
(
struct
net_device
*
dev
)
...
...
@@ -622,7 +627,7 @@ static int myri_start_xmit(struct sk_buff *skb, struct net_device *dev)
return
1
;
}
s
ave_and_cli
(
flags
);
s
pin_lock_irqsave
(
&
mp
->
irq_lock
,
flags
);
DHDR
((
"xmit[skbdata(%p)]
\n
"
,
skb
->
data
));
#ifdef DEBUG_HEADER
...
...
@@ -669,7 +674,7 @@ static int myri_start_xmit(struct sk_buff *skb, struct net_device *dev)
DTX
((
"tbusy=0, returning 0
\n
"
));
netif_start_queue
(
dev
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
mp
->
irq_lock
,
flags
);
return
0
;
}
...
...
@@ -900,6 +905,7 @@ static int __init myri_ether_init(struct net_device *dev, struct sbus_dev *sdev,
printk
(
"%s: MyriCOM MyriNET Ethernet "
,
dev
->
name
);
mp
=
(
struct
myri_eth
*
)
dev
->
priv
;
spin_lock_init
(
&
mp
->
irq_lock
);
mp
->
myri_sdev
=
sdev
;
/* Clean out skb arrays. */
...
...
drivers/net/myri_sbus.h
View file @
130ca59d
...
...
@@ -269,6 +269,7 @@ struct myri_eth {
/* These are frequently accessed, keep together
* to obtain good cache hit rates.
*/
spinlock_t
irq_lock
;
struct
myri_shmem
*
shmem
;
/* Shared data structures. */
unsigned
long
cregs
;
/* Control register space. */
struct
recvq
*
rqack
;
/* Where we ack rx's. */
...
...
drivers/sbus/char/openprom.c
View file @
130ca59d
...
...
@@ -147,7 +147,6 @@ static int openprom_sunos_ioctl(struct inode * inode, struct file * file,
DATA
*
data
=
(
DATA
*
)
file
->
private_data
;
char
buffer
[
OPROMMAXPARAM
+
1
],
*
buf
;
struct
openpromio
*
opp
;
unsigned
long
flags
;
int
bufsize
,
len
,
error
=
0
;
extern
char
saved_command_line
[];
static
int
cnt
;
...
...
@@ -163,18 +162,14 @@ static int openprom_sunos_ioctl(struct inode * inode, struct file * file,
switch
(
cmd
)
{
case
OPROMGETOPT
:
case
OPROMGETPROP
:
save_and_cli
(
flags
);
len
=
prom_getproplen
(
node
,
opp
->
oprom_array
);
restore_flags
(
flags
);
if
(
len
<=
0
||
len
>
bufsize
)
{
error
=
copyout
((
void
*
)
arg
,
opp
,
sizeof
(
int
));
break
;
}
save_and_cli
(
flags
);
len
=
prom_getproperty
(
node
,
opp
->
oprom_array
,
buffer
,
bufsize
);
restore_flags
(
flags
);
memcpy
(
opp
->
oprom_array
,
buffer
,
len
);
opp
->
oprom_array
[
len
]
=
'\0'
;
...
...
@@ -185,9 +180,7 @@ static int openprom_sunos_ioctl(struct inode * inode, struct file * file,
case
OPROMNXTOPT
:
case
OPROMNXTPROP
:
save_and_cli
(
flags
);
buf
=
prom_nextprop
(
node
,
opp
->
oprom_array
,
buffer
);
restore_flags
(
flags
);
len
=
strlen
(
buf
);
if
(
len
==
0
||
len
+
1
>
bufsize
)
{
...
...
@@ -207,10 +200,8 @@ static int openprom_sunos_ioctl(struct inode * inode, struct file * file,
buf
=
opp
->
oprom_array
+
strlen
(
opp
->
oprom_array
)
+
1
;
len
=
opp
->
oprom_array
+
bufsize
-
buf
;
save_and_cli
(
flags
);
error
=
prom_setprop
(
options_node
,
opp
->
oprom_array
,
buf
,
len
);
restore_flags
(
flags
);
if
(
error
<
0
)
error
=
-
EINVAL
;
...
...
@@ -226,13 +217,11 @@ static int openprom_sunos_ioctl(struct inode * inode, struct file * file,
node
=
*
((
int
*
)
opp
->
oprom_array
);
save_and_cli
(
flags
);
switch
(
cmd
)
{
case
OPROMNEXT
:
node
=
__prom_getsibling
(
node
);
break
;
case
OPROMCHILD
:
node
=
__prom_getchild
(
node
);
break
;
case
OPROMSETCUR
:
break
;
}
restore_flags
(
flags
);
data
->
current_node
=
node
;
*
((
int
*
)
opp
->
oprom_array
)
=
node
;
...
...
@@ -264,9 +253,7 @@ static int openprom_sunos_ioctl(struct inode * inode, struct file * file,
break
;
case
OPROMPATH2NODE
:
save_and_cli
(
flags
);
node
=
prom_finddevice
(
opp
->
oprom_array
);
restore_flags
(
flags
);
data
->
current_node
=
node
;
*
((
int
*
)
opp
->
oprom_array
)
=
node
;
opp
->
oprom_size
=
sizeof
(
int
);
...
...
@@ -361,7 +348,6 @@ static int openprom_bsd_ioctl(struct inode * inode, struct file * file,
{
DATA
*
data
=
(
DATA
*
)
file
->
private_data
;
struct
opiocdesc
op
;
unsigned
long
flags
;
int
error
,
node
,
len
;
char
*
str
,
*
tmp
;
char
buffer
[
64
];
...
...
@@ -379,9 +365,7 @@ static int openprom_bsd_ioctl(struct inode * inode, struct file * file,
if
(
error
)
return
error
;
save_and_cli
(
flags
);
len
=
prom_getproplen
(
op
.
op_nodeid
,
str
);
restore_flags
(
flags
);
if
(
len
>
op
.
op_buflen
)
{
kfree
(
str
);
...
...
@@ -405,9 +389,7 @@ static int openprom_bsd_ioctl(struct inode * inode, struct file * file,
return
-
ENOMEM
;
}
save_and_cli
(
flags
);
prom_getproperty
(
op
.
op_nodeid
,
str
,
tmp
,
len
);
restore_flags
(
flags
);
tmp
[
len
]
=
'\0'
;
...
...
@@ -431,9 +413,7 @@ static int openprom_bsd_ioctl(struct inode * inode, struct file * file,
if
(
error
)
return
error
;
save_and_cli
(
flags
);
tmp
=
prom_nextprop
(
op
.
op_nodeid
,
str
,
buffer
);
restore_flags
(
flags
);
if
(
tmp
)
{
len
=
strlen
(
tmp
);
...
...
@@ -481,9 +461,7 @@ static int openprom_bsd_ioctl(struct inode * inode, struct file * file,
return
error
;
}
save_and_cli
(
flags
);
len
=
prom_setprop
(
op
.
op_nodeid
,
str
,
tmp
,
op
.
op_buflen
+
1
);
restore_flags
(
flags
);
if
(
len
!=
op
.
op_buflen
)
return
-
EINVAL
;
...
...
@@ -503,12 +481,10 @@ static int openprom_bsd_ioctl(struct inode * inode, struct file * file,
if
(
copy_from_user
(
&
node
,
(
void
*
)
arg
,
sizeof
(
int
)))
return
-
EFAULT
;
save_and_cli
(
flags
);
if
(
cmd
==
OPIOCGETNEXT
)
node
=
__prom_getsibling
(
node
);
else
node
=
__prom_getchild
(
node
);
restore_flags
(
flags
);
if
(
__copy_to_user
((
void
*
)
arg
,
&
node
,
sizeof
(
int
)))
return
-
EFAULT
;
...
...
@@ -624,7 +600,6 @@ static struct miscdevice openprom_dev = {
static
int
__init
openprom_init
(
void
)
{
unsigned
long
flags
;
int
error
;
error
=
misc_register
(
&
openprom_dev
);
...
...
@@ -633,10 +608,8 @@ static int __init openprom_init(void)
return
error
;
}
save_and_cli
(
flags
);
options_node
=
prom_getchild
(
prom_root_node
);
options_node
=
prom_searchsiblings
(
options_node
,
"options"
);
restore_flags
(
flags
);
if
(
options_node
==
0
||
options_node
==
-
1
)
{
printk
(
KERN_ERR
"openprom: unable to find options node
\n
"
);
...
...
drivers/scsi/qlogicpti.c
View file @
130ca59d
...
...
@@ -318,7 +318,7 @@ static int qlogicpti_reset_hardware(struct Scsi_Host *host)
risc_code_addr
=
0x1000
;
/* all load addresses are at 0x1000 */
s
ave_flags
(
flags
);
cli
(
);
s
pin_lock_irqsave
(
&
qpti
->
lock
,
flags
);
sbus_writew
(
HCCTRL_PAUSE
,
qpti
->
qregs
+
HCCTRL
);
...
...
@@ -366,7 +366,7 @@ static int qlogicpti_reset_hardware(struct Scsi_Host *host)
if
(
qlogicpti_mbox_command
(
qpti
,
param
,
1
))
{
printk
(
KERN_EMERG
"qlogicpti%d: Cannot execute ISP firmware.
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
...
...
@@ -377,7 +377,7 @@ static int qlogicpti_reset_hardware(struct Scsi_Host *host)
(
param
[
0
]
!=
MBOX_COMMAND_COMPLETE
))
{
printk
(
KERN_EMERG
"qlogicpti%d: Cannot set initiator SCSI ID.
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
...
...
@@ -392,7 +392,7 @@ static int qlogicpti_reset_hardware(struct Scsi_Host *host)
if
(
qlogicpti_mbox_command
(
qpti
,
param
,
1
))
{
printk
(
KERN_EMERG
"qlogicpti%d: Cannot init response queue.
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
...
...
@@ -404,7 +404,7 @@ static int qlogicpti_reset_hardware(struct Scsi_Host *host)
if
(
qlogicpti_mbox_command
(
qpti
,
param
,
1
))
{
printk
(
KERN_EMERG
"qlogicpti%d: Cannot init request queue.
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
...
...
@@ -450,7 +450,7 @@ static int qlogicpti_reset_hardware(struct Scsi_Host *host)
qlogicpti_mbox_command
(
qpti
,
param
,
0
);
qpti
->
send_marker
=
1
;
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
0
;
}
...
...
@@ -468,7 +468,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
risc_code_addr
=
0x1000
;
/* all f/w modules load at 0x1000 */
risc_code_length
=
sbus_risc_code_length01
;
s
ave_flags
(
flags
);
cli
(
);
s
pin_lock_irqsave
(
&
qpti
->
lock
,
flags
);
/* Verify the checksum twice, one before loading it, and once
* afterwards via the mailbox commands.
...
...
@@ -476,7 +476,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
for
(
i
=
0
;
i
<
risc_code_length
;
i
++
)
csum
+=
risc_code
[
i
];
if
(
csum
)
{
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
printk
(
KERN_EMERG
"qlogicpti%d: Aieee, firmware checksum failed!"
,
qpti
->
qpti_id
);
return
1
;
...
...
@@ -488,7 +488,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
while
(
--
timeout
&&
(
sbus_readw
(
qpti
->
qregs
+
SBUS_CTRL
)
&
SBUS_CTRL_RESET
))
udelay
(
20
);
if
(
!
timeout
)
{
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
printk
(
KERN_EMERG
"qlogicpti%d: Cannot reset the ISP."
,
qpti
->
qpti_id
);
return
1
;
}
...
...
@@ -528,7 +528,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
if
(
qlogicpti_mbox_command
(
qpti
,
param
,
1
))
{
printk
(
KERN_EMERG
"qlogicpti%d: Cannot stop firmware for reload.
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
...
...
@@ -541,7 +541,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
param
[
0
]
!=
MBOX_COMMAND_COMPLETE
)
{
printk
(
"qlogicpti%d: Firmware dload failed, I'm bolixed!
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
}
...
...
@@ -561,7 +561,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
(
param
[
0
]
!=
MBOX_COMMAND_COMPLETE
))
{
printk
(
KERN_EMERG
"qlogicpti%d: New firmware csum failure!
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
...
...
@@ -575,7 +575,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
(
param
[
0
]
!=
MBOX_COMMAND_COMPLETE
))
{
printk
(
KERN_EMERG
"qlogicpti%d: AboutFirmware cmd fails.
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
...
...
@@ -591,7 +591,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
(
param
[
0
]
!=
MBOX_COMMAND_COMPLETE
))
{
printk
(
KERN_EMERG
"qlogicpti%d: could not set clock rate.
\n
"
,
qpti
->
qpti_id
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
1
;
}
...
...
@@ -608,7 +608,7 @@ static int __init qlogicpti_load_firmware(struct qlogicpti *qpti)
qlogicpti_mbox_command
(
qpti
,
param
,
1
);
}
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
0
;
}
...
...
@@ -1166,8 +1166,8 @@ static void ourdone(Scsi_Cmnd *Cmnd)
int
qlogicpti_queuecommand_slow
(
Scsi_Cmnd
*
Cmnd
,
void
(
*
done
)(
Scsi_Cmnd
*
))
{
unsigned
long
flags
;
struct
qlogicpti
*
qpti
=
(
struct
qlogicpti
*
)
Cmnd
->
host
->
hostdata
;
unsigned
long
flags
;
/*
* done checking this host adapter?
...
...
@@ -1178,12 +1178,13 @@ int qlogicpti_queuecommand_slow(Scsi_Cmnd *Cmnd, void (*done)(Scsi_Cmnd *))
if
(
qpti
->
sbits
&&
qpti
->
sbits
!=
0xffff
)
{
/* See above about in ourdone this ugliness... */
Cmnd
->
SCp
.
Message
=
((
unsigned
long
)
done
)
&
0xffffffff
;
#ifdef
__sparc_v9__
#ifdef
CONFIG_SPARC64
Cmnd
->
SCp
.
Status
=
((
unsigned
long
)
done
>>
32UL
)
&
0xffffffff
;
#endif
return
qlogicpti_queuecommand
(
Cmnd
,
ourdone
);
}
save_flags
(
flags
);
cli
();
spin_lock_irqsave
(
&
qpti
->
lock
,
flags
);
/*
* We've peeked at all targets for this bus- time
...
...
@@ -1226,7 +1227,8 @@ int qlogicpti_queuecommand_slow(Scsi_Cmnd *Cmnd, void (*done)(Scsi_Cmnd *))
if
(
qpti
==
NULL
)
Cmnd
->
host
->
hostt
->
queuecommand
=
qlogicpti_queuecommand
;
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
qpti
->
lock
,
flags
);
return
qlogicpti_queuecommand
(
Cmnd
,
done
);
}
...
...
drivers/serial/sunsab.c
View file @
130ca59d
/* $Id: sab82532.c,v 1.66 2002/01/08 16:00:16 davem Exp $
* sab82532.c: ASYNC Driver for the SIEMENS SAB82532 DUSCC.
/* sunsab.c: ASYNC Driver for the SIEMENS SAB82532 DUSCC.
*
* Copyright (C) 1997 Eddie C. Dost (ecd@skynet.be)
* Copyright (C) 2002 David S. Miller (davem@redhat.com)
*
* Rewrote buffer handling to use CIRC(Circular Buffer) macros.
* Maxim Krasnyanskiy <maxk@qualcomm.com>
...
...
@@ -10,92 +10,61 @@
* rates to be programmed into the UART. Also eliminated a lot of
* duplicated code in the console setup.
* Theodore Ts'o <tytso@mit.edu>, 2001-Oct-12
*
* Ported to new 2.5.x UART layer.
* David S. Miller <davem@redhat.com>
*/
#include <linux/config.h>
#include <linux/module.h>
#include <linux/errno.h>
#include <linux/signal.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/timer.h>
#include <linux/interrupt.h>
#include <linux/errno.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <linux/serial.h>
#include <linux/serialP.h>
#include <linux/serial_reg.h>
#include <linux/console.h>
#include <linux/major.h>
#include <linux/string.h>
#include <linux/fcntl.h>
#include <linux/ptrace.h>
#include <linux/ioport.h>
#include <linux/mm.h>
#include <linux/circ_buf.h>
#include <linux/serial.h>
#include <linux/console.h>
#include <linux/spinlock.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <asm/sab82532.h>
#include <asm/uaccess.h>
#include <asm/ebus.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/oplib.h>
#include <asm/ebus.h>
#include "sunserial.h"
static
DECLARE_TASK_QUEUE
(
tq_serial
);
/* This is (one of many) a special gross hack to allow SU and
* SAB serials to co-exist on the same machine. -DaveM
*/
#undef SERIAL_BH
#define SERIAL_BH AURORA_BH
static
struct
tty_driver
serial_driver
,
callout_driver
;
static
int
sab82532_refcount
;
#undef SERIAL_PARANOIA_CHECK
#define SERIAL_DO_RESTART
/* Set of debugging defines */
#undef SERIAL_DEBUG_OPEN
#undef SERIAL_DEBUG_FLOW
#undef SERIAL_DEBUG_MODEM
#undef SERIAL_DEBUG_WAIT_UNTIL_SENT
#undef SERIAL_DEBUG_SEND_BREAK
#undef SERIAL_DEBUG_INTR
#undef SERIAL_DEBUG_FIFO
#define SERIAL_DEBUG_OVERFLOW 1
/* Trace things on serial device, useful for console debugging: */
#undef SERIAL_LOG_DEVICE
#ifdef SERIAL_LOG_DEVICE
static
void
dprint_init
(
int
tty
);
#endif
static
void
change_speed
(
struct
sab82532
*
info
);
static
void
sab82532_wait_until_sent
(
struct
tty_struct
*
tty
,
int
timeout
);
#include <linux/serial_core.h>
#include "suncore.h"
#include "sunsab.h"
struct
uart_sunsab_port
{
struct
uart_port
port
;
/* Generic UART port */
union
sab82532_async_regs
*
regs
;
/* Chip registers */
unsigned
long
irqflags
;
/* IRQ state flags */
int
xmit_fifo_size
;
/* TX fifo size */
int
recv_fifo_size
;
/* RX fifo size */
int
dsr
;
/* Current DSR state */
unsigned
int
cec_timeout
;
/* Chip poll timeout... */
unsigned
int
tec_timeout
;
/* likewise */
unsigned
char
interrupt_mask0
;
/* ISR0 masking */
unsigned
char
interrupt_mask1
;
/* ISR1 masking */
unsigned
char
pvr_dtr_bit
;
/* Which PVR bit is DTR */
unsigned
char
pvr_dsr_bit
;
/* Which PVR bit is DSR */
int
type
;
/* SAB82532 version */
int
sab_line
;
/* Internal numbering */
unsigned
int
irq
;
/* Device interrupt */
};
/*
* This assumes you have a 29.4912 MHz clock for your UART.
*/
#define BASE_BAUD ( 29491200 / 16 )
static
struct
sab82532
*
sab82532_chain
=
0
;
static
struct
tty_struct
*
sab82532_table
[
NR_PORTS
];
static
struct
termios
*
sab82532_termios
[
NR_PORTS
];
static
struct
termios
*
sab82532_termios_locked
[
NR_PORTS
];
#ifdef CONFIG_SERIAL_CONSOLE
extern
int
serial_console
;
static
struct
console
sab82532_console
;
static
int
sab82532_console_init
(
void
);
static
void
batten_down_hatches
(
struct
sab82532
*
info
);
#endif
#ifndef MIN
#define MIN(a,b) ((a) < (b) ? (a) : (b))
#endif
#define SAB_BASE_BAUD ( 29491200 / 16 )
static
char
*
sab82532_version
[
16
]
=
{
"V1.0"
,
"V2.0"
,
"V3.2"
,
"V(0x03)"
,
...
...
@@ -103,840 +72,600 @@ static char *sab82532_version[16] = {
"V(0x08)"
,
"V(0x09)"
,
"V(0x0a)"
,
"V(0x0b)"
,
"V(0x0c)"
,
"V(0x0d)"
,
"V(0x0e)"
,
"V(0x0f)"
};
static
char
serial_version
[
16
];
/*
* tmp_buf is used as a temporary buffer by sab82532_write. We need to
* lock it in case the copy_from_user blocks while swapping in a page,
* and some other program tries to do a serial write at the same time.
* Since the lock will only come under contention when the system is
* swapping and available memory is low, it makes sense to share one
* buffer across all the serial ports, since it significantly saves
* memory if large numbers of serial ports are open.
*/
static
unsigned
char
*
tmp_buf
=
0
;
static
DECLARE_MUTEX
(
tmp_buf_sem
);
static
inline
int
serial_paranoia_check
(
struct
sab82532
*
info
,
kdev_t
device
,
const
char
*
routine
)
{
#ifdef SERIAL_PARANOIA_CHECK
static
const
char
*
badmagic
=
"Warning: bad magic number for serial struct (%s) in %s
\n
"
;
static
const
char
*
badinfo
=
"Warning: null sab82532 for (%s) in %s
\n
"
;
if
(
!
info
)
{
printk
(
badinfo
,
kdevname
(
device
),
routine
);
return
1
;
}
if
(
info
->
magic
!=
SERIAL_MAGIC
)
{
printk
(
badmagic
,
kdevname
(
device
),
routine
);
return
1
;
}
#endif
return
0
;
}
/*
* This is used to figure out the divisor speeds.
*
* The formula is: Baud = BASE_BAUD / ((N + 1) * (1 << M)),
*
* with 0 <= N < 64 and 0 <= M < 16
*
* 12-Oct-2001 - Replaced table driven approach with code written by
* Theodore Ts'o <tytso@alum.mit.edu> which exactly replicates the
* table. (Modulo bugs for the 307200 and 61440 baud rates, which
* were clearly incorrectly calculated in the original table. This is
* why tables filled with magic constants are evil.)
*/
static
void
calc_ebrg
(
int
baud
,
int
*
n_ret
,
int
*
m_ret
)
{
int
n
,
m
;
if
(
baud
==
0
)
{
*
n_ret
=
0
;
*
m_ret
=
0
;
return
;
}
/*
* We scale numbers by 10 so that we get better accuracy
* without having to use floating point. Here we increment m
* until n is within the valid range.
*/
n
=
(
BASE_BAUD
*
10
)
/
baud
;
m
=
0
;
while
(
n
>=
640
)
{
n
=
n
/
2
;
m
++
;
}
n
=
(
n
+
5
)
/
10
;
/*
* We try very hard to avoid speeds with M == 0 since they may
* not work correctly for XTAL frequences above 10 MHz.
*/
if
((
m
==
0
)
&&
((
n
&
1
)
==
0
))
{
n
=
n
/
2
;
m
++
;
}
*
n_ret
=
n
-
1
;
*
m_ret
=
m
;
}
#define SAB82532_MAX_TEC_TIMEOUT 200000
/* 1 character time (at 50 baud) */
#define SAB82532_MAX_CEC_TIMEOUT 50000
/* 2.5 TX CLKs (at 50 baud) */
static
__inline__
void
s
ab82532_tec_wait
(
struct
sab82532
*
info
)
static
__inline__
void
s
unsab_tec_wait
(
struct
uart_sunsab_port
*
up
)
{
int
timeout
=
info
->
tec_timeout
;
int
timeout
=
up
->
tec_timeout
;
while
((
readb
(
&
info
->
regs
->
r
.
star
)
&
SAB82532_STAR_TEC
)
&&
--
timeout
)
while
((
readb
(
&
up
->
regs
->
r
.
star
)
&
SAB82532_STAR_TEC
)
&&
--
timeout
)
udelay
(
1
);
}
static
__inline__
void
s
ab82532_cec_wait
(
struct
sab82532
*
info
)
static
__inline__
void
s
unsab_cec_wait
(
struct
uart_sunsab_port
*
up
)
{
int
timeout
=
info
->
cec_timeout
;
int
timeout
=
up
->
cec_timeout
;
while
((
readb
(
&
info
->
regs
->
r
.
star
)
&
SAB82532_STAR_CEC
)
&&
--
timeout
)
while
((
readb
(
&
up
->
regs
->
r
.
star
)
&
SAB82532_STAR_CEC
)
&&
--
timeout
)
udelay
(
1
);
}
static
__inline__
void
sab82532_start_tx
(
struct
sab82532
*
info
)
{
unsigned
long
flags
;
int
i
;
save_flags
(
flags
);
cli
();
if
(
info
->
xmit
.
head
==
info
->
xmit
.
tail
)
goto
out
;
if
(
!
test_bit
(
SAB82532_XPR
,
&
info
->
irqflags
))
goto
out
;
info
->
interrupt_mask1
&=
~
(
SAB82532_IMR1_ALLS
);
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
clear_bit
(
SAB82532_ALLS
,
&
info
->
irqflags
);
clear_bit
(
SAB82532_XPR
,
&
info
->
irqflags
);
for
(
i
=
0
;
i
<
info
->
xmit_fifo_size
;
i
++
)
{
writeb
(
info
->
xmit
.
buf
[
info
->
xmit
.
tail
],
&
info
->
regs
->
w
.
xfifo
[
i
]);
info
->
xmit
.
tail
=
(
info
->
xmit
.
tail
+
1
)
&
(
SERIAL_XMIT_SIZE
-
1
);
info
->
icount
.
tx
++
;
if
(
info
->
xmit
.
head
==
info
->
xmit
.
tail
)
break
;
}
/* Issue a Transmit Frame command. */
sab82532_cec_wait
(
info
);
writeb
(
SAB82532_CMDR_XF
,
&
info
->
regs
->
w
.
cmdr
);
out:
restore_flags
(
flags
);
}
/*
* ------------------------------------------------------------
* sab82532_stop() and sab82532_start()
*
* This routines are called before setting or resetting tty->stopped.
* They enable or disable transmitter interrupts, as necessary.
* ------------------------------------------------------------
*/
static
void
sab82532_stop
(
struct
tty_struct
*
tty
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
unsigned
long
flags
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_stop"
))
return
;
save_flags
(
flags
);
cli
();
info
->
interrupt_mask1
|=
SAB82532_IMR1_XPR
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
restore_flags
(
flags
);
}
static
void
sab82532_start
(
struct
tty_struct
*
tty
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
unsigned
long
flags
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_start"
))
return
;
save_flags
(
flags
);
cli
();
info
->
interrupt_mask1
&=
~
(
SAB82532_IMR1_XPR
);
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
sab82532_start_tx
(
info
);
restore_flags
(
flags
);
}
/*
* ----------------------------------------------------------------------
*
* Here starts the interrupt handling routines. All of the following
* subroutines are declared as inline and are folded into
* sab82532_interrupt(). They were separated out for readability's sake.
*
* Note: sab82532_interrupt() is a "fast" interrupt, which means that it
* runs with interrupts turned off. People who may want to modify
* sab82532_interrupt() should try to keep the interrupt handler as fast as
* possible. After you are done making modifications, it is not a bad
* idea to do:
*
* gcc -S -DKERNEL -Wall -Wstrict-prototypes -O6 -fomit-frame-pointer serial.c
*
* and look at the resulting assemble code in serial.s.
*
* - Ted Ts'o (tytso@mit.edu), 7-Mar-93
* -----------------------------------------------------------------------
*/
/*
* This routine is used by the interrupt handler to schedule
* processing in the software interrupt portion of the driver.
*/
static
void
sab82532_sched_event
(
struct
sab82532
*
info
,
int
event
)
{
info
->
event
|=
1
<<
event
;
queue_task
(
&
info
->
tqueue
,
&
tq_serial
);
mark_bh
(
SERIAL_BH
);
}
static
void
receive_chars
(
struct
sab82532
*
info
,
union
sab82532_irq_status
*
stat
)
static
void
receive_chars
(
struct
uart_sunsab_port
*
up
,
union
sab82532_irq_status
*
stat
,
struct
pt_regs
*
regs
)
{
struct
tty_struct
*
tty
=
info
->
tty
;
struct
tty_struct
*
tty
=
up
->
port
.
info
->
tty
;
unsigned
char
buf
[
32
];
unsigned
char
status
;
int
saw_console_brk
=
0
;
int
free_fifo
=
0
;
int
i
,
count
=
0
;
int
count
=
0
;
int
i
;
/* Read number of BYTES (Character + Status) available. */
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_RPF
)
{
count
=
info
->
recv_fifo_size
;
count
=
up
->
recv_fifo_size
;
free_fifo
++
;
}
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_TCD
)
{
count
=
readb
(
&
info
->
regs
->
r
.
rbcl
)
&
(
info
->
recv_fifo_size
-
1
);
count
=
readb
(
&
up
->
regs
->
r
.
rbcl
)
&
(
up
->
recv_fifo_size
-
1
);
free_fifo
++
;
}
/* Issue a FIFO read command in case we where idle. */
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_TIME
)
{
s
ab82532_cec_wait
(
info
);
writeb
(
SAB82532_CMDR_RFRD
,
&
info
->
regs
->
w
.
cmdr
);
s
unsab_cec_wait
(
up
);
writeb
(
SAB82532_CMDR_RFRD
,
&
up
->
regs
->
w
.
cmdr
);
return
;
}
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_RFO
)
{
#ifdef SERIAL_DEBUG_OVERFLOW
printk
(
"sab82532: receive_chars: RFO"
);
#endif
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_RFO
)
free_fifo
++
;
}
/* Read the FIFO. */
for
(
i
=
0
;
i
<
count
;
i
++
)
buf
[
i
]
=
readb
(
&
info
->
regs
->
r
.
rfifo
[
i
]);
buf
[
i
]
=
readb
(
&
up
->
regs
->
r
.
rfifo
[
i
]);
/* Issue Receive Message Complete command. */
if
(
free_fifo
)
{
s
ab82532_cec_wait
(
info
);
writeb
(
SAB82532_CMDR_RMC
,
&
info
->
regs
->
w
.
cmdr
);
s
unsab_cec_wait
(
up
);
writeb
(
SAB82532_CMDR_RMC
,
&
up
->
regs
->
w
.
cmdr
);
}
if
(
!
tty
)
return
;
for
(
i
=
0
;
i
<
count
;
i
++
)
{
unsigned
char
ch
=
buf
[
i
]
;
for
(
i
=
0
;
i
<
count
;
)
{
if
(
tty
->
flip
.
count
>=
TTY_FLIPBUF_SIZE
)
{
#ifdef SERIAL_DEBUG_OVERFLOW
printk
(
"sab82532: receive_chars: tty overrun
\n
"
);
#endif
info
->
icount
.
buf_overrun
++
;
break
;
if
(
unlikely
(
tty
->
flip
.
count
>=
TTY_FLIPBUF_SIZE
))
{
tty
->
flip
.
tqueue
.
routine
((
void
*
)
tty
);
if
(
tty
->
flip
.
count
>=
TTY_FLIPBUF_SIZE
)
return
;
// if TTY_DONT_FLIP is set
}
tty
->
flip
.
count
++
;
*
tty
->
flip
.
char_buf_ptr
++
=
buf
[
i
++
];
status
=
buf
[
i
++
];
info
->
icount
.
rx
++
;
*
tty
->
flip
.
char_buf_ptr
=
ch
;
*
tty
->
flip
.
flag_buf_ptr
=
TTY_NORMAL
;
up
->
port
.
icount
.
rx
++
;
if
(
unlikely
(
stat
->
sreg
.
isr0
&
(
SAB82532_ISR0_PERR
|
SAB82532_ISR0_FERR
|
SAB82532_ISR0_RFO
))
||
unlikely
(
stat
->
sreg
.
isr1
&
SAB82532_ISR1_BRK
))
{
/*
* For statistics only
*/
if
(
stat
->
sreg
.
isr1
&
SAB82532_ISR1_BRK
)
{
stat
->
sreg
.
isr0
&=
~
(
SAB82532_ISR0_PERR
|
SAB82532_ISR0_FERR
);
up
->
port
.
icount
.
brk
++
;
if
(
up
->
port
.
line
==
up
->
port
.
cons
->
index
)
saw_console_brk
=
1
;
/*
* We do the SysRQ and SAK checking
* here because otherwise the break
* may get masked by ignore_status_mask
* or read_status_mask.
*/
if
(
uart_handle_break
(
&
up
->
port
))
continue
;
}
else
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_PERR
)
up
->
port
.
icount
.
parity
++
;
else
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_FERR
)
up
->
port
.
icount
.
frame
++
;
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_RFO
)
up
->
port
.
icount
.
overrun
++
;
/*
* Mask off conditions which should be ingored.
*/
stat
->
sreg
.
isr0
&=
(
up
->
port
.
read_status_mask
&
0xff
);
stat
->
sreg
.
isr1
&=
((
up
->
port
.
read_status_mask
>>
8
)
&
0xff
);
if
(
stat
->
sreg
.
isr1
&
SAB82532_ISR1_BRK
)
{
*
tty
->
flip
.
flag_buf_ptr
=
TTY_BREAK
;
}
else
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_PERR
)
*
tty
->
flip
.
flag_buf_ptr
=
TTY_PARITY
;
else
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_FERR
)
*
tty
->
flip
.
flag_buf_ptr
=
TTY_FRAME
;
}
#ifdef SERIAL_DEBUG_INTR
printk
(
"DR%02x:%02x..."
,
(
unsigned
char
)
*
(
tty
->
flip
.
char_buf_ptr
-
1
),
status
);
#endif
if
(
uart_handle_sysrq_char
(
&
up
->
port
,
ch
,
regs
))
continue
;
if
(
status
&
SAB82532_RSTAT_PE
)
{
*
tty
->
flip
.
flag_buf_ptr
++
=
TTY_PARITY
;
info
->
icount
.
parity
++
;
}
else
if
(
status
&
SAB82532_RSTAT_FE
)
{
*
tty
->
flip
.
flag_buf_ptr
++
=
TTY_FRAME
;
info
->
icount
.
frame
++
;
if
((
stat
->
sreg
.
isr0
&
(
up
->
port
.
ignore_status_mask
&
0xff
))
==
0
&&
(
stat
->
sreg
.
isr1
&
((
up
->
port
.
ignore_status_mask
>>
8
)
&
0xff
))
==
0
){
tty
->
flip
.
flag_buf_ptr
++
;
tty
->
flip
.
char_buf_ptr
++
;
tty
->
flip
.
count
++
;
}
if
((
stat
->
sreg
.
isr0
&
SAB82532_ISR0_RFO
)
&&
tty
->
flip
.
count
<
TTY_FLIPBUF_SIZE
)
{
/*
* Overrun is special, since it's reported
* immediately, and doesn't affect the current
* character.
*/
*
tty
->
flip
.
flag_buf_ptr
=
TTY_OVERRUN
;
tty
->
flip
.
flag_buf_ptr
++
;
tty
->
flip
.
char_buf_ptr
++
;
tty
->
flip
.
count
++
;
}
else
*
tty
->
flip
.
flag_buf_ptr
++
=
TTY_NORMAL
;
}
queue_task
(
&
tty
->
flip
.
tqueue
,
&
tq_timer
);
tty_flip_buffer_push
(
tty
);
if
(
saw_console_brk
)
sun_do_break
();
}
static
void
transmit_chars
(
struct
sab82532
*
info
,
static
void
sunsab_stop_tx
(
struct
uart_port
*
,
unsigned
int
);
static
void
transmit_chars
(
struct
uart_sunsab_port
*
up
,
union
sab82532_irq_status
*
stat
)
{
struct
circ_buf
*
xmit
=
&
up
->
port
.
info
->
xmit
;
int
i
;
if
(
stat
->
sreg
.
isr1
&
SAB82532_ISR1_ALLS
)
{
info
->
interrupt_mask1
|=
SAB82532_IMR1_ALLS
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
set_bit
(
SAB82532_ALLS
,
&
info
->
irqflags
);
up
->
interrupt_mask1
|=
SAB82532_IMR1_ALLS
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
set_bit
(
SAB82532_ALLS
,
&
up
->
irqflags
);
}
if
(
!
(
stat
->
sreg
.
isr1
&
SAB82532_ISR1_XPR
))
return
;
if
(
!
(
readb
(
&
info
->
regs
->
r
.
star
)
&
SAB82532_STAR_XFW
))
{
#ifdef SERIAL_DEBUG_FIFO
printk
(
"%s: XPR, but no XFW (?)
\n
"
,
__FUNCTION__
);
#endif
if
(
!
(
readb
(
&
up
->
regs
->
r
.
star
)
&
SAB82532_STAR_XFW
))
return
;
}
set_bit
(
SAB82532_XPR
,
&
info
->
irqflags
);
if
(
!
info
->
tty
)
{
info
->
interrupt_mask1
|=
SAB82532_IMR1_XPR
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
return
;
}
set_bit
(
SAB82532_XPR
,
&
up
->
irqflags
);
if
((
info
->
xmit
.
head
==
info
->
xmit
.
tail
)
||
info
->
tty
->
stopped
||
info
->
tty
->
hw_stopped
)
{
info
->
interrupt_mask1
|=
SAB82532_IMR1_XPR
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
if
(
uart_circ_empty
(
xmit
)
||
uart_tx_stopped
(
&
up
->
port
))
{
up
->
interrupt_mask1
|=
SAB82532_IMR1_XPR
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
return
;
}
info
->
interrupt_mask1
&=
~
(
SAB82532_IMR1_ALLS
);
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
clear_bit
(
SAB82532_ALLS
,
&
info
->
irqflags
);
up
->
interrupt_mask1
&=
~
(
SAB82532_IMR1_ALLS
);
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
clear_bit
(
SAB82532_ALLS
,
&
up
->
irqflags
);
/* Stuff 32 bytes into Transmit FIFO. */
clear_bit
(
SAB82532_XPR
,
&
info
->
irqflags
);
for
(
i
=
0
;
i
<
info
->
xmit_fifo_size
;
i
++
)
{
writeb
(
info
->
xmit
.
buf
[
info
->
xmit
.
tail
],
&
info
->
regs
->
w
.
xfifo
[
i
]);
info
->
xmit
.
tail
=
(
info
->
xmit
.
tail
+
1
)
&
(
SERIAL_XMIT_SIZE
-
1
);
info
->
icount
.
tx
++
;
if
(
info
->
xmit
.
head
==
info
->
xmit
.
tail
)
clear_bit
(
SAB82532_XPR
,
&
up
->
irqflags
);
for
(
i
=
0
;
i
<
up
->
xmit_fifo_size
;
i
++
)
{
writeb
(
xmit
->
buf
[
xmit
->
tail
],
&
up
->
regs
->
w
.
xfifo
[
i
]);
xmit
->
tail
=
(
xmit
->
tail
+
1
)
&
(
UART_XMIT_SIZE
-
1
);
up
->
port
.
icount
.
tx
++
;
if
(
uart_circ_empty
(
xmit
)
)
break
;
}
/* Issue a Transmit Frame command. */
s
ab82532_cec_wait
(
info
);
writeb
(
SAB82532_CMDR_XF
,
&
info
->
regs
->
w
.
cmdr
);
s
unsab_cec_wait
(
up
);
writeb
(
SAB82532_CMDR_XF
,
&
up
->
regs
->
w
.
cmdr
);
if
(
CIRC_CNT
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
)
<
WAKEUP_CHARS
)
sab82532_sched_event
(
info
,
RS_EVEN
T_WRITE_WAKEUP
);
if
(
uart_circ_chars_pending
(
xmit
)
<
WAKEUP_CHARS
)
uart_event
(
&
up
->
port
,
EV
T_WRITE_WAKEUP
);
#ifdef SERIAL_DEBUG_INTR
printk
(
"THRE..."
);
#endif
if
(
uart_circ_empty
(
xmit
))
sunsab_stop_tx
(
&
up
->
port
,
0
);
}
static
void
check_status
(
struct
sab82532
*
info
,
static
void
check_status
(
struct
uart_sunsab_port
*
up
,
union
sab82532_irq_status
*
stat
)
{
struct
tty_struct
*
tty
=
info
->
tty
;
int
modem_change
=
0
;
if
(
stat
->
sreg
.
isr1
&
SAB82532_ISR1_BRK
)
{
#ifdef CONFIG_SERIAL_CONSOLE
if
(
info
->
is_console
)
{
sun_do_break
(
info
);
return
;
}
#endif
if
(
tty
->
flip
.
count
>=
TTY_FLIPBUF_SIZE
)
{
info
->
icount
.
buf_overrun
++
;
goto
check_modem
;
}
tty
->
flip
.
count
++
;
*
tty
->
flip
.
flag_buf_ptr
++
=
TTY_PARITY
;
*
tty
->
flip
.
char_buf_ptr
++
=
0
;
info
->
icount
.
brk
++
;
}
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_CDSC
)
uart_handle_dcd_change
(
&
up
->
port
,
!
(
readb
(
&
up
->
regs
->
r
.
vstr
)
&
SAB82532_VSTR_CD
));
if
(
!
tty
)
return
;
if
(
stat
->
sreg
.
isr1
&
SAB82532_ISR1_CSC
)
uart_handle_cts_change
(
&
up
->
port
,
(
readb
(
&
up
->
regs
->
r
.
star
)
&
SAB82532_STAR_CTS
));
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_RFO
)
{
if
(
tty
->
flip
.
count
>=
TTY_FLIPBUF_SIZE
)
{
info
->
icount
.
buf_overrun
++
;
goto
check_modem
;
}
tty
->
flip
.
count
++
;
*
tty
->
flip
.
flag_buf_ptr
++
=
TTY_PARITY
;
*
tty
->
flip
.
char_buf_ptr
++
=
0
;
info
->
icount
.
overrun
++
;
if
((
readb
(
&
up
->
regs
->
r
.
pvr
)
&
up
->
pvr_dsr_bit
)
^
up
->
dsr
)
{
up
->
dsr
=
(
readb
(
&
up
->
regs
->
r
.
pvr
)
&
up
->
pvr_dsr_bit
)
?
0
:
1
;
up
->
port
.
icount
.
dsr
++
;
}
check_modem:
if
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_CDSC
)
{
info
->
dcd
=
(
readb
(
&
info
->
regs
->
r
.
vstr
)
&
SAB82532_VSTR_CD
)
?
0
:
1
;
info
->
icount
.
dcd
++
;
modem_change
++
;
#ifdef SERIAL_DEBUG_MODEM
printk
(
"DCD change: %d
\n
"
,
info
->
icount
.
dcd
);
#endif
}
if
(
stat
->
sreg
.
isr1
&
SAB82532_ISR1_CSC
)
{
info
->
cts
=
readb
(
&
info
->
regs
->
r
.
star
)
&
SAB82532_STAR_CTS
;
info
->
icount
.
cts
++
;
modem_change
++
;
#ifdef SERIAL_DEBUG_MODEM
printk
(
"CTS change: %d, CTS %s
\n
"
,
info
->
icount
.
cts
,
info
->
cts
?
"on"
:
"off"
);
#endif
}
if
((
readb
(
&
info
->
regs
->
r
.
pvr
)
&
info
->
pvr_dsr_bit
)
^
info
->
dsr
)
{
info
->
dsr
=
(
readb
(
&
info
->
regs
->
r
.
pvr
)
&
info
->
pvr_dsr_bit
)
?
0
:
1
;
info
->
icount
.
dsr
++
;
modem_change
++
;
#ifdef SERIAL_DEBUG_MODEM
printk
(
"DSR change: %d
\n
"
,
info
->
icount
.
dsr
);
#endif
}
if
(
modem_change
)
wake_up_interruptible
(
&
info
->
delta_msr_wait
);
wake_up_interruptible
(
&
up
->
port
.
info
->
delta_msr_wait
);
}
if
((
info
->
flags
&
ASYNC_CHECK_CD
)
&&
(
stat
->
sreg
.
isr0
&
SAB82532_ISR0_CDSC
))
{
static
void
sunsab_interrupt
(
int
irq
,
void
*
dev_id
,
struct
pt_regs
*
regs
)
{
struct
uart_sunsab_port
*
up
=
dev_id
;
union
sab82532_irq_status
status
;
unsigned
long
flags
;
#if (defined(SERIAL_DEBUG_OPEN) || defined(SERIAL_DEBUG_INTR))
printk
(
"ttys%d CD now %s..."
,
info
->
line
,
(
info
->
dcd
)
?
"on"
:
"off"
);
#endif
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
if
(
info
->
dcd
)
wake_up_interruptible
(
&
info
->
open_wait
);
else
if
(
!
((
info
->
flags
&
ASYNC_CALLOUT_ACTIVE
)
&&
(
info
->
flags
&
ASYNC_CALLOUT_NOHUP
)))
{
status
.
stat
=
0
;
if
(
readb
(
&
up
->
regs
->
r
.
gis
)
&
SAB82532_GIS_ISA0
)
status
.
sreg
.
isr0
=
readb
(
&
up
->
regs
->
r
.
isr0
);
if
(
readb
(
&
up
->
regs
->
r
.
gis
)
&
SAB82532_GIS_ISA1
)
status
.
sreg
.
isr1
=
readb
(
&
up
->
regs
->
r
.
isr1
);
#ifdef SERIAL_DEBUG_OPEN
printk
(
"scheduling hangup..."
);
#endif
MOD_INC_USE_COUNT
;
if
(
schedule_task
(
&
info
->
tqueue_hangup
)
==
0
)
MOD_DEC_USE_COUNT
;
}
if
(
status
.
stat
)
{
if
(
status
.
sreg
.
isr0
&
(
SAB82532_ISR0_TCD
|
SAB82532_ISR0_TIME
|
SAB82532_ISR0_RFO
|
SAB82532_ISR0_RPF
))
receive_chars
(
up
,
&
status
,
regs
);
if
((
status
.
sreg
.
isr0
&
SAB82532_ISR0_CDSC
)
||
(
status
.
sreg
.
isr1
&
SAB82532_ISR1_CSC
))
check_status
(
up
,
&
status
);
if
(
status
.
sreg
.
isr1
&
(
SAB82532_ISR1_ALLS
|
SAB82532_ISR1_XPR
))
transmit_chars
(
up
,
&
status
);
}
if
(
info
->
flags
&
ASYNC_CTS_FLOW
)
{
if
(
info
->
tty
->
hw_stopped
)
{
if
(
info
->
cts
)
{
spin_unlock
(
&
up
->
port
.
lock
);
#if (defined(SERIAL_DEBUG_INTR) || defined(SERIAL_DEBUG_FLOW))
printk
(
"CTS tx start..."
);
#endif
info
->
tty
->
hw_stopped
=
0
;
sab82532_sched_event
(
info
,
RS_EVENT_WRITE_WAKEUP
);
info
->
interrupt_mask1
&=
~
(
SAB82532_IMR1_XPR
);
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
sab82532_start_tx
(
info
);
}
}
else
{
if
(
!
(
info
->
cts
))
{
up
++
;
#if (defined(SERIAL_DEBUG_INTR) || defined(SERIAL_DEBUG_FLOW))
printk
(
"CTS tx stop..."
);
#endif
info
->
tty
->
hw_stopped
=
1
;
}
}
spin_lock
(
&
up
->
port
.
lock
);
status
.
stat
=
0
;
if
(
readb
(
&
up
->
regs
->
r
.
gis
)
&
SAB82532_GIS_ISB0
)
status
.
sreg
.
isr0
=
readb
(
&
up
->
regs
->
r
.
isr0
);
if
(
readb
(
&
up
->
regs
->
r
.
gis
)
&
SAB82532_GIS_ISB1
)
status
.
sreg
.
isr1
=
readb
(
&
up
->
regs
->
r
.
isr1
);
if
(
status
.
stat
)
{
if
(
status
.
sreg
.
isr0
&
(
SAB82532_ISR0_TCD
|
SAB82532_ISR0_TIME
|
SAB82532_ISR0_RFO
|
SAB82532_ISR0_RPF
))
receive_chars
(
up
,
&
status
,
regs
);
if
((
status
.
sreg
.
isr0
&
SAB82532_ISR0_CDSC
)
||
(
status
.
sreg
.
isr1
&
(
SAB82532_ISR1_BRK
|
SAB82532_ISR1_CSC
)))
check_status
(
up
,
&
status
);
if
(
status
.
sreg
.
isr1
&
(
SAB82532_ISR1_ALLS
|
SAB82532_ISR1_XPR
))
transmit_chars
(
up
,
&
status
);
}
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
}
/* port->lock is not held. */
static
unsigned
int
sunsab_tx_empty
(
struct
uart_port
*
port
)
{
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
int
ret
;
/* Do not need a lock for a state test like this. */
if
(
test_bit
(
SAB82532_ALLS
,
&
up
->
irqflags
))
ret
=
TIOCSER_TEMT
;
else
ret
=
0
;
return
ret
;
}
/* port->lock held by caller. */
static
void
sunsab_set_mctrl
(
struct
uart_port
*
port
,
unsigned
int
mctrl
)
{
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
if
(
mctrl
&
TIOCM_RTS
)
{
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
&
~
SAB82532_MODE_FRTS
,
&
up
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
up
->
regs
->
rw
.
mode
);
}
else
{
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FRTS
,
&
up
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
up
->
regs
->
rw
.
mode
);
}
if
(
mctrl
&
TIOCM_DTR
)
{
writeb
(
readb
(
&
up
->
regs
->
rw
.
pvr
)
&
~
(
up
->
pvr_dtr_bit
),
&
up
->
regs
->
rw
.
pvr
);
}
else
{
writeb
(
readb
(
&
up
->
regs
->
rw
.
pvr
)
|
up
->
pvr_dtr_bit
,
&
up
->
regs
->
rw
.
pvr
);
}
}
/*
* This is the serial driver's generic interrupt routine
*/
static
void
sab82532_interrupt
(
int
irq
,
void
*
dev_id
,
struct
pt_regs
*
regs
)
/* port->lock is not held. */
static
unsigned
int
sunsab_get_mctrl
(
struct
uart_port
*
port
)
{
struct
sab82532
*
info
=
dev_id
;
union
sab82532_irq_status
status
;
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
unsigned
long
flags
;
unsigned
char
val
;
unsigned
int
result
;
#ifdef SERIAL_DEBUG_INTR
printk
(
"sab82532_interrupt(%d)..."
,
irq
);
#endif
result
=
0
;
status
.
stat
=
0
;
if
(
readb
(
&
info
->
regs
->
r
.
gis
)
&
SAB82532_GIS_ISA0
)
status
.
sreg
.
isr0
=
readb
(
&
info
->
regs
->
r
.
isr0
);
if
(
readb
(
&
info
->
regs
->
r
.
gis
)
&
SAB82532_GIS_ISA1
)
status
.
sreg
.
isr1
=
readb
(
&
info
->
regs
->
r
.
isr1
);
#ifdef SERIAL_DEBUG_INTR
printk
(
"%d<%02x.%02x>"
,
info
->
line
,
status
.
sreg
.
isr0
,
status
.
sreg
.
isr1
);
#endif
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
if
(
!
status
.
stat
)
goto
next
;
val
=
readb
(
&
up
->
regs
->
r
.
pvr
);
result
|=
(
val
&
up
->
pvr_dsr_bit
)
?
0
:
TIOCM_DSR
;
if
(
status
.
sreg
.
isr0
&
(
SAB82532_ISR0_TCD
|
SAB82532_ISR0_TIME
|
SAB82532_ISR0_RFO
|
SAB82532_ISR0_RPF
))
receive_chars
(
info
,
&
status
);
if
((
status
.
sreg
.
isr0
&
SAB82532_ISR0_CDSC
)
||
(
status
.
sreg
.
isr1
&
(
SAB82532_ISR1_BRK
|
SAB82532_ISR1_CSC
)))
check_status
(
info
,
&
status
);
if
(
status
.
sreg
.
isr1
&
(
SAB82532_ISR1_ALLS
|
SAB82532_ISR1_XPR
))
transmit_chars
(
info
,
&
status
);
val
=
readb
(
&
up
->
regs
->
r
.
vstr
);
result
|=
(
val
&
SAB82532_VSTR_CD
)
?
0
:
TIOCM_CAR
;
next:
info
=
info
->
next
;
status
.
stat
=
0
;
if
(
readb
(
&
info
->
regs
->
r
.
gis
)
&
SAB82532_GIS_ISB0
)
status
.
sreg
.
isr0
=
readb
(
&
info
->
regs
->
r
.
isr0
);
if
(
readb
(
&
info
->
regs
->
r
.
gis
)
&
SAB82532_GIS_ISB1
)
status
.
sreg
.
isr1
=
readb
(
&
info
->
regs
->
r
.
isr1
);
#ifdef SERIAL_DEBUG_INTR
printk
(
"%d<%02x.%02x>"
,
info
->
line
,
status
.
sreg
.
isr0
,
status
.
sreg
.
isr1
);
#endif
val
=
readb
(
&
up
->
regs
->
r
.
star
);
result
|=
(
val
&
SAB82532_STAR_CTS
)
?
TIOCM_CTS
:
0
;
if
(
!
status
.
stat
)
goto
done
;
if
(
status
.
sreg
.
isr0
&
(
SAB82532_ISR0_TCD
|
SAB82532_ISR0_TIME
|
SAB82532_ISR0_RFO
|
SAB82532_ISR0_RPF
))
receive_chars
(
info
,
&
status
);
if
((
status
.
sreg
.
isr0
&
SAB82532_ISR0_CDSC
)
||
(
status
.
sreg
.
isr1
&
(
SAB82532_ISR1_BRK
|
SAB82532_ISR1_CSC
)))
check_status
(
info
,
&
status
);
if
(
status
.
sreg
.
isr1
&
(
SAB82532_ISR1_ALLS
|
SAB82532_ISR1_XPR
))
transmit_chars
(
info
,
&
status
);
done:
;
#ifdef SERIAL_DEBUG_INTR
printk
(
"end.
\n
"
);
#endif
}
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
/*
* -------------------------------------------------------------------
* Here ends the serial interrupt routines.
* -------------------------------------------------------------------
*/
return
result
;
}
/*
* This routine is used to handle the "bottom half" processing for the
* serial driver, known also the "software interrupt" processing.
* This processing is done at the kernel interrupt level, after the
* sab82532_interrupt() has returned, BUT WITH INTERRUPTS TURNED ON. This
* is where time-consuming activities which can not be done in the
* interrupt driver proper are done; the interrupt driver schedules
* them using sab82532_sched_event(), and they get done here.
*/
static
void
do_serial_bh
(
void
)
/* port->lock held by caller. */
static
void
sunsab_stop_tx
(
struct
uart_port
*
port
,
unsigned
int
tty_stop
)
{
run_task_queue
(
&
tq_serial
);
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
up
->
interrupt_mask1
|=
SAB82532_IMR1_XPR
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
}
static
void
do_softint
(
void
*
private_
)
/* port->lock held by caller. */
static
void
sunsab_start_tx
(
struct
uart_port
*
port
,
unsigned
int
tty_start
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
private_
;
struct
tty_struct
*
tty
;
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
struct
circ_buf
*
xmit
=
&
up
->
port
.
info
->
xmit
;
int
i
;
tty
=
info
->
tty
;
if
(
!
tty
)
if
(
!
test_bit
(
SAB82532_XPR
,
&
up
->
irqflags
))
return
;
if
(
test_and_clear_bit
(
RS_EVENT_WRITE_WAKEUP
,
&
info
->
event
))
{
if
((
tty
->
flags
&
(
1
<<
TTY_DO_WRITE_WAKEUP
))
&&
tty
->
ldisc
.
write_wakeup
)
(
tty
->
ldisc
.
write_wakeup
)(
tty
);
wake_up_interruptible
(
&
tty
->
write_wait
);
up
->
interrupt_mask1
&=
~
SAB82532_IMR1_XPR
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
clear_bit
(
SAB82532_ALLS
,
&
up
->
irqflags
);
clear_bit
(
SAB82532_XPR
,
&
up
->
irqflags
);
for
(
i
=
0
;
i
<
up
->
xmit_fifo_size
;
i
++
)
{
writeb
(
xmit
->
buf
[
xmit
->
tail
],
&
up
->
regs
->
w
.
xfifo
[
i
]);
xmit
->
tail
=
(
xmit
->
tail
+
1
)
&
(
UART_XMIT_SIZE
-
1
);
up
->
port
.
icount
.
tx
++
;
if
(
uart_circ_empty
(
xmit
))
break
;
}
/* Issue a Transmit Frame command. */
sunsab_cec_wait
(
up
);
writeb
(
SAB82532_CMDR_XF
,
&
up
->
regs
->
w
.
cmdr
);
}
/*
* This routine is called from the scheduler tqueue when the interrupt
* routine has signalled that a hangup has occurred. The path of
* hangup processing is:
*
* serial interrupt routine -> (scheduler tqueue) ->
* do_serial_hangup() -> tty->hangup() -> sab82532_hangup()
*
*/
static
void
do_serial_hangup
(
void
*
private_
)
/* port->lock is not held. */
static
void
sunsab_send_xchar
(
struct
uart_port
*
port
,
char
ch
)
{
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
unsigned
long
flags
;
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
sunsab_tec_wait
(
up
);
writeb
(
ch
,
&
up
->
regs
->
w
.
tic
);
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
}
/* port->lock held by caller. */
static
void
sunsab_stop_rx
(
struct
uart_port
*
port
)
{
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
up
->
interrupt_mask0
|=
SAB82532_ISR0_TCD
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr0
);
}
/* port->lock held by caller. */
static
void
sunsab_enable_ms
(
struct
uart_port
*
port
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
private_
;
struct
tty_struct
*
tty
;
/* For now we always receive these interrupts. */
}
/* port->lock is not held. */
static
void
sunsab_break_ctl
(
struct
uart_port
*
port
,
int
break_state
)
{
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
unsigned
long
flags
;
unsigned
char
val
;
tty
=
info
->
tty
;
if
(
tty
)
tty_hangup
(
tty
);
MOD_DEC_USE_COUNT
;
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
val
=
readb
(
&
up
->
regs
->
rw
.
dafo
);
if
(
break_state
)
val
|=
SAB82532_DAFO_XBRK
;
else
val
&=
~
SAB82532_DAFO_XBRK
;
writeb
(
val
,
&
up
->
regs
->
rw
.
dafo
);
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
}
static
void
s
ab82532_init_line
(
struct
sab82532
*
info
)
/* port->lock is not held. */
s
tatic
int
sunsab_startup
(
struct
uart_port
*
port
)
{
unsigned
char
stat
,
tmp
;
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
unsigned
long
flags
;
unsigned
char
tmp
;
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
/*
* Wait for any commands or immediate characters
*/
s
ab82532_cec_wait
(
info
);
s
ab82532_tec_wait
(
info
);
s
unsab_cec_wait
(
up
);
s
unsab_tec_wait
(
up
);
/*
* Clear the FIFO buffers.
*/
writeb
(
SAB82532_CMDR_RRES
,
&
info
->
regs
->
w
.
cmdr
);
s
ab82532_cec_wait
(
info
);
writeb
(
SAB82532_CMDR_XRES
,
&
info
->
regs
->
w
.
cmdr
);
writeb
(
SAB82532_CMDR_RRES
,
&
up
->
regs
->
w
.
cmdr
);
s
unsab_cec_wait
(
up
);
writeb
(
SAB82532_CMDR_XRES
,
&
up
->
regs
->
w
.
cmdr
);
/*
* Clear the interrupt registers.
*/
stat
=
readb
(
&
info
->
regs
->
r
.
isr0
);
stat
=
readb
(
&
info
->
regs
->
r
.
isr1
);
(
void
)
readb
(
&
up
->
regs
->
r
.
isr0
);
(
void
)
readb
(
&
up
->
regs
->
r
.
isr1
);
/*
* Now, initialize the UART
*/
writeb
(
0
,
&
info
->
regs
->
w
.
ccr0
);
/* power-down */
writeb
(
0
,
&
up
->
regs
->
w
.
ccr0
);
/* power-down */
writeb
(
SAB82532_CCR0_MCE
|
SAB82532_CCR0_SC_NRZ
|
SAB82532_CCR0_SM_ASYNC
,
&
info
->
regs
->
w
.
ccr0
);
writeb
(
SAB82532_CCR1_ODS
|
SAB82532_CCR1_BCR
|
7
,
&
info
->
regs
->
w
.
ccr1
);
SAB82532_CCR0_SM_ASYNC
,
&
up
->
regs
->
w
.
ccr0
);
writeb
(
SAB82532_CCR1_ODS
|
SAB82532_CCR1_BCR
|
7
,
&
up
->
regs
->
w
.
ccr1
);
writeb
(
SAB82532_CCR2_BDF
|
SAB82532_CCR2_SSEL
|
SAB82532_CCR2_TOE
,
&
info
->
regs
->
w
.
ccr2
);
writeb
(
0
,
&
info
->
regs
->
w
.
ccr3
);
writeb
(
SAB82532_CCR4_MCK4
|
SAB82532_CCR4_EBRG
,
&
info
->
regs
->
w
.
ccr4
);
SAB82532_CCR2_TOE
,
&
up
->
regs
->
w
.
ccr2
);
writeb
(
0
,
&
up
->
regs
->
w
.
ccr3
);
writeb
(
SAB82532_CCR4_MCK4
|
SAB82532_CCR4_EBRG
,
&
up
->
regs
->
w
.
ccr4
);
writeb
(
SAB82532_MODE_RTS
|
SAB82532_MODE_FCTS
|
SAB82532_MODE_RAC
,
&
info
->
regs
->
w
.
mode
);
writeb
(
SAB82532_RFC_DPS
|
SAB82532_RFC_RFDF
,
&
info
->
regs
->
w
.
rfc
);
switch
(
info
->
recv_fifo_size
)
{
SAB82532_MODE_RAC
,
&
up
->
regs
->
w
.
mode
);
writeb
(
SAB82532_RFC_DPS
|
SAB82532_RFC_RFDF
,
&
up
->
regs
->
w
.
rfc
);
switch
(
up
->
recv_fifo_size
)
{
case
1
:
tmp
=
readb
(
&
info
->
regs
->
w
.
rfc
);
tmp
=
readb
(
&
up
->
regs
->
w
.
rfc
);
tmp
|=
SAB82532_RFC_RFTH_1
;
writeb
(
tmp
,
&
info
->
regs
->
w
.
rfc
);
writeb
(
tmp
,
&
up
->
regs
->
w
.
rfc
);
break
;
case
4
:
tmp
=
readb
(
&
info
->
regs
->
w
.
rfc
);
tmp
=
readb
(
&
up
->
regs
->
w
.
rfc
);
tmp
|=
SAB82532_RFC_RFTH_4
;
writeb
(
tmp
,
&
info
->
regs
->
w
.
rfc
);
writeb
(
tmp
,
&
up
->
regs
->
w
.
rfc
);
break
;
case
16
:
tmp
=
readb
(
&
info
->
regs
->
w
.
rfc
);
tmp
=
readb
(
&
up
->
regs
->
w
.
rfc
);
tmp
|=
SAB82532_RFC_RFTH_16
;
writeb
(
tmp
,
&
info
->
regs
->
w
.
rfc
);
writeb
(
tmp
,
&
up
->
regs
->
w
.
rfc
);
break
;
default:
info
->
recv_fifo_size
=
32
;
up
->
recv_fifo_size
=
32
;
/* fall through */
case
32
:
tmp
=
readb
(
&
info
->
regs
->
w
.
rfc
);
tmp
=
readb
(
&
up
->
regs
->
w
.
rfc
);
tmp
|=
SAB82532_RFC_RFTH_32
;
writeb
(
tmp
,
&
info
->
regs
->
w
.
rfc
);
writeb
(
tmp
,
&
up
->
regs
->
w
.
rfc
);
break
;
}
tmp
=
readb
(
&
info
->
regs
->
rw
.
ccr0
);
};
tmp
=
readb
(
&
up
->
regs
->
rw
.
ccr0
);
tmp
|=
SAB82532_CCR0_PU
;
/* power-up */
writeb
(
tmp
,
&
info
->
regs
->
rw
.
ccr0
);
writeb
(
tmp
,
&
up
->
regs
->
rw
.
ccr0
);
/*
* Finally, enable interrupts
*/
up
->
interrupt_mask0
=
(
SAB82532_IMR0_PERR
|
SAB82532_IMR0_FERR
|
SAB82532_IMR0_PLLA
);
writeb
(
up
->
interrupt_mask0
,
&
up
->
regs
->
w
.
imr0
);
up
->
interrupt_mask1
=
(
SAB82532_IMR1_BRKT
|
SAB82532_IMR1_ALLS
|
SAB82532_IMR1_XOFF
|
SAB82532_IMR1_TIN
|
SAB82532_IMR1_CSC
|
SAB82532_IMR1_XON
|
SAB82532_IMR1_XPR
);
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
set_bit
(
SAB82532_ALLS
,
&
up
->
irqflags
);
set_bit
(
SAB82532_XPR
,
&
up
->
irqflags
);
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
return
0
;
}
static
int
startup
(
struct
sab82532
*
info
)
/* port->lock is not held. */
static
void
sunsab_shutdown
(
struct
uart_port
*
port
)
{
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
unsigned
long
flags
;
unsigned
long
page
;
int
retval
=
0
;
unsigned
char
tmp
;
page
=
get_free_page
(
GFP_KERNEL
);
if
(
!
page
)
return
-
ENOMEM
;
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
save_flags
(
flags
);
cli
();
/* Disable Interrupts */
up
->
interrupt_mask0
=
0xff
;
writeb
(
up
->
interrupt_mask0
,
&
up
->
regs
->
w
.
imr0
);
up
->
interrupt_mask1
=
0xff
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
if
(
info
->
flags
&
ASYNC_INITIALIZED
)
{
free_page
(
page
);
goto
errout
;
}
/* Disable break condition */
tmp
=
readb
(
&
up
->
regs
->
rw
.
dafo
);
tmp
&=
~
SAB82532_DAFO_XBRK
;
writeb
(
tmp
,
&
up
->
regs
->
rw
.
dafo
);
if
(
!
info
->
regs
)
{
if
(
info
->
tty
)
set_bit
(
TTY_IO_ERROR
,
&
info
->
tty
->
flags
);
free_page
(
page
);
retval
=
-
ENODEV
;
goto
errout
;
}
if
(
info
->
xmit
.
buf
)
free_page
(
page
);
else
info
->
xmit
.
buf
=
(
unsigned
char
*
)
page
;
/* Disable Receiver */
tmp
=
readb
(
&
up
->
regs
->
rw
.
mode
);
tmp
&=
~
SAB82532_MODE_RAC
;
writeb
(
tmp
,
&
up
->
regs
->
rw
.
mode
);
#ifdef SERIAL_DEBUG_OPEN
printk
(
"starting up serial port %d..."
,
info
->
line
);
#endif
/* Power Down */
tmp
=
readb
(
&
up
->
regs
->
rw
.
ccr0
);
tmp
&=
~
SAB82532_CCR0_PU
;
writeb
(
tmp
,
&
up
->
regs
->
rw
.
ccr0
);
/*
* Initialize the Hardware
*/
sab82532_init_line
(
info
);
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
}
if
(
info
->
tty
->
termios
->
c_cflag
&
CBAUD
)
{
u8
tmp
;
/*
* This is used to figure out the divisor speeds.
*
* The formula is: Baud = SAB_BASE_BAUD / ((N + 1) * (1 << M)),
*
* with 0 <= N < 64 and 0 <= M < 16
*/
tmp
=
readb
(
&
info
->
regs
->
rw
.
mode
);
tmp
&=
~
(
SAB82532_MODE_FRTS
);
tmp
|=
SAB82532_MODE_RTS
;
writeb
(
tmp
,
&
info
->
regs
->
rw
.
mode
);
static
void
calc_ebrg
(
int
baud
,
int
*
n_ret
,
int
*
m_ret
)
{
int
n
,
m
;
tmp
=
readb
(
&
info
->
regs
->
rw
.
pvr
);
tmp
&=
~
(
info
->
pvr_dtr_bit
);
writeb
(
tmp
,
&
info
->
regs
->
rw
.
pvr
);
if
(
baud
==
0
)
{
*
n_ret
=
0
;
*
m_ret
=
0
;
return
;
}
/*
* Finally, enable interrupts
*/
info
->
interrupt_mask0
=
SAB82532_IMR0_PERR
|
SAB82532_IMR0_FERR
|
SAB82532_IMR0_PLLA
;
writeb
(
info
->
interrupt_mask0
,
&
info
->
regs
->
w
.
imr0
);
info
->
interrupt_mask1
=
SAB82532_IMR1_BRKT
|
SAB82532_IMR1_ALLS
|
SAB82532_IMR1_XOFF
|
SAB82532_IMR1_TIN
|
SAB82532_IMR1_CSC
|
SAB82532_IMR1_XON
|
SAB82532_IMR1_XPR
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
set_bit
(
SAB82532_ALLS
,
&
info
->
irqflags
);
if
(
info
->
tty
)
clear_bit
(
TTY_IO_ERROR
,
&
info
->
tty
->
flags
);
info
->
xmit
.
head
=
info
->
xmit
.
tail
=
0
;
set_bit
(
SAB82532_XPR
,
&
info
->
irqflags
);
/*
* and set the speed of the serial port
* We scale numbers by 10 so that we get better accuracy
* without having to use floating point. Here we increment m
* until n is within the valid range.
*/
change_speed
(
info
);
info
->
flags
|=
ASYNC_INITIALIZED
;
restore_flags
(
flags
);
return
0
;
errout:
restore_flags
(
flags
);
return
retval
;
}
/*
* This routine will shutdown a serial port; interrupts are disabled, and
* DTR is dropped if the hangup on close termio flag is on.
*/
static
void
shutdown
(
struct
sab82532
*
info
)
{
unsigned
long
flags
;
u8
tmp
;
if
(
!
(
info
->
flags
&
ASYNC_INITIALIZED
))
return
;
#ifdef SERIAL_DEBUG_OPEN
printk
(
"Shutting down serial port %d..."
,
info
->
line
);
#endif
save_flags
(
flags
);
cli
();
/* Disable interrupts */
n
=
(
SAB_BASE_BAUD
*
10
)
/
baud
;
m
=
0
;
while
(
n
>=
640
)
{
n
=
n
/
2
;
m
++
;
}
n
=
(
n
+
5
)
/
10
;
/*
*
clear delta_msr_wait queue to avoid mem leaks: we may free the irq
*
here so the queue might never be waken up
*
We try very hard to avoid speeds with M == 0 since they may
*
not work correctly for XTAL frequences above 10 MHz.
*/
wake_up_interruptible
(
&
info
->
delta_msr_wait
);
if
(
info
->
xmit
.
buf
)
{
free_page
((
unsigned
long
)
info
->
xmit
.
buf
);
info
->
xmit
.
buf
=
0
;
}
if
(
info
->
is_console
)
{
info
->
interrupt_mask0
=
SAB82532_IMR0_PERR
|
SAB82532_IMR0_FERR
|
SAB82532_IMR0_PLLA
|
SAB82532_IMR0_CDSC
;
writeb
(
info
->
interrupt_mask0
,
&
info
->
regs
->
w
.
imr0
);
info
->
interrupt_mask1
=
SAB82532_IMR1_BRKT
|
SAB82532_IMR1_ALLS
|
SAB82532_IMR1_XOFF
|
SAB82532_IMR1_TIN
|
SAB82532_IMR1_CSC
|
SAB82532_IMR1_XON
|
SAB82532_IMR1_XPR
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
if
(
info
->
tty
)
set_bit
(
TTY_IO_ERROR
,
&
info
->
tty
->
flags
);
info
->
flags
&=
~
ASYNC_INITIALIZED
;
restore_flags
(
flags
);
return
;
}
/* Disable Interrupts */
info
->
interrupt_mask0
=
0xff
;
writeb
(
info
->
interrupt_mask0
,
&
info
->
regs
->
w
.
imr0
);
info
->
interrupt_mask1
=
0xff
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
if
(
!
info
->
tty
||
(
info
->
tty
->
termios
->
c_cflag
&
HUPCL
))
{
tmp
=
readb
(
&
info
->
regs
->
r
.
mode
);
tmp
|=
(
SAB82532_MODE_FRTS
|
SAB82532_MODE_RTS
);
writeb
(
tmp
,
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
pvr
)
|
info
->
pvr_dtr_bit
,
&
info
->
regs
->
rw
.
pvr
);
if
((
m
==
0
)
&&
((
n
&
1
)
==
0
))
{
n
=
n
/
2
;
m
++
;
}
/* Disable break condition */
tmp
=
readb
(
&
info
->
regs
->
rw
.
dafo
);
tmp
&=
~
(
SAB82532_DAFO_XBRK
);
writeb
(
tmp
,
&
info
->
regs
->
rw
.
dafo
);
/* Disable Receiver */
tmp
=
readb
(
&
info
->
regs
->
rw
.
mode
);
tmp
&=
~
(
SAB82532_MODE_RAC
);
writeb
(
tmp
,
&
info
->
regs
->
rw
.
mode
);
/* Power Down */
tmp
=
readb
(
&
info
->
regs
->
rw
.
ccr0
);
tmp
&=
~
(
SAB82532_CCR0_PU
);
writeb
(
tmp
,
&
info
->
regs
->
rw
.
ccr0
);
if
(
info
->
tty
)
set_bit
(
TTY_IO_ERROR
,
&
info
->
tty
->
flags
);
info
->
flags
&=
~
ASYNC_INITIALIZED
;
restore_flags
(
flags
);
*
n_ret
=
n
-
1
;
*
m_ret
=
m
;
}
/*
* This routine is called to set the UART divisor registers to match
* the specified baud rate for a serial port.
*/
static
void
change_speed
(
struct
sab82532
*
info
)
/* Internal routine, port->lock is held and local interrupts are disabled. */
static
void
sunsab_convert_to_sab
(
struct
uart_sunsab_port
*
up
,
unsigned
int
cflag
,
unsigned
int
iflag
,
int
baud
)
{
unsigned
long
flags
;
unsigned
int
ebrg
;
tcflag_t
cflag
;
unsigned
char
dafo
;
int
bits
,
n
,
m
;
if
(
!
info
->
tty
||
!
info
->
tty
->
termios
)
return
;
cflag
=
info
->
tty
->
termios
->
c_cflag
;
unsigned
int
ebrg
;
unsigned
char
dafo
;
int
bits
,
n
,
m
;
/* Byte size and parity */
switch
(
cflag
&
CSIZE
)
{
...
...
@@ -959,1173 +688,296 @@ static void change_speed(struct sab82532 *info)
}
if
(
cflag
&
PARODD
)
{
#ifdef CMSPAR
if
(
cflag
&
CMSPAR
)
dafo
|=
SAB82532_DAFO_PAR_MARK
;
else
#endif
dafo
|=
SAB82532_DAFO_PAR_ODD
;
dafo
|=
SAB82532_DAFO_PAR_ODD
;
}
else
{
#ifdef CMSPAR
if
(
cflag
&
CMSPAR
)
dafo
|=
SAB82532_DAFO_PAR_SPACE
;
else
#endif
dafo
|=
SAB82532_DAFO_PAR_EVEN
;
dafo
|=
SAB82532_DAFO_PAR_EVEN
;
}
/* Determine EBRG values based on baud rate */
info
->
baud
=
tty_get_baud_rate
(
info
->
tty
);
calc_ebrg
(
info
->
baud
,
&
n
,
&
m
);
calc_ebrg
(
baud
,
&
n
,
&
m
);
ebrg
=
n
|
(
m
<<
6
);
if
(
info
->
baud
)
{
info
->
timeout
=
(
info
->
xmit_fifo_size
*
HZ
*
bits
)
/
info
->
baud
;
info
->
tec_timeout
=
(
10
*
1000000
)
/
info
->
baud
;
info
->
cec_timeout
=
info
->
tec_timeout
>>
2
;
}
else
{
info
->
timeout
=
0
;
info
->
tec_timeout
=
SAB82532_MAX_TEC_TIMEOUT
;
info
->
cec_timeout
=
SAB82532_MAX_CEC_TIMEOUT
;
}
info
->
timeout
+=
HZ
/
50
;
/* Add .02 seconds of slop */
up
->
tec_timeout
=
(
10
*
1000000
)
/
baud
;
up
->
cec_timeout
=
up
->
tec_timeout
>>
2
;
/* CTS flow control flags */
if
(
cflag
&
CRTSCTS
)
info
->
flags
|=
ASYNC_CTS_FLOW
;
else
info
->
flags
&=
~
(
ASYNC_CTS_FLOW
);
if
(
cflag
&
CLOCAL
)
info
->
flags
&=
~
(
ASYNC_CHECK_CD
);
else
info
->
flags
|=
ASYNC_CHECK_CD
;
if
(
info
->
tty
)
info
->
tty
->
hw_stopped
=
0
;
/*
* Set up parity check flag
* XXX: not implemented, yet.
/* We encode read_status_mask and ignore_status_mask like so:
*
* ---------------------
* | ... | ISR1 | ISR0 |
* ---------------------
* .. 15 8 7 0
*/
#define RELEVANT_IFLAG(iflag) (iflag & (IGNBRK|BRKINT|IGNPAR|PARMRK|INPCK))
up
->
port
.
read_status_mask
=
(
SAB82532_ISR0_TCD
|
SAB82532_ISR0_TIME
|
SAB82532_ISR0_RFO
|
SAB82532_ISR0_RPF
|
SAB82532_ISR0_CDSC
);
up
->
port
.
read_status_mask
|=
(
SAB82532_ISR1_CSC
|
SAB82532_ISR1_ALLS
|
SAB82532_ISR1_XPR
)
<<
8
;
if
(
iflag
&
INPCK
)
up
->
port
.
read_status_mask
|=
(
SAB82532_ISR0_PERR
|
SAB82532_ISR0_FERR
);
if
(
iflag
&
(
BRKINT
|
PARMRK
))
up
->
port
.
read_status_mask
|=
(
SAB82532_ISR1_BRK
<<
8
);
/*
* Characters to ignore
* XXX: not implemented, yet.
* Characteres to ignore
*/
up
->
port
.
ignore_status_mask
=
0
;
if
(
iflag
&
IGNPAR
)
up
->
port
.
ignore_status_mask
|=
(
SAB82532_ISR0_PERR
|
SAB82532_ISR0_FERR
);
if
(
iflag
&
IGNBRK
)
{
up
->
port
.
ignore_status_mask
|=
(
SAB82532_ISR1_BRK
<<
8
);
/*
* If we're ignoring parity and break indicators,
* ignore overruns too (for real raw support).
*/
if
(
iflag
&
IGNPAR
)
up
->
port
.
ignore_status_mask
|=
SAB82532_ISR0_RFO
;
}
/*
* !!! ignore all characters if CREAD is not set
* XXX: not implemented, yet.
* ignore all characters if CREAD is not set
*/
if
((
cflag
&
CREAD
)
==
0
)
info
->
ignore_status_mask
|=
SAB82532_ISR0_RPF
|
SAB82532_ISR0_TCD
|
SAB82532_ISR0_TIME
;
save_flags
(
flags
);
cli
();
sab82532_cec_wait
(
info
);
sab82532_tec_wait
(
info
);
writeb
(
dafo
,
&
info
->
regs
->
w
.
dafo
);
writeb
(
ebrg
&
0xff
,
&
info
->
regs
->
w
.
bgr
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
ccr2
)
&
~
(
0xc0
),
&
info
->
regs
->
rw
.
ccr2
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
ccr2
)
|
((
ebrg
>>
2
)
&
0xc0
),
&
info
->
regs
->
rw
.
ccr2
);
if
(
info
->
flags
&
ASYNC_CTS_FLOW
)
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
&
~
(
SAB82532_MODE_RTS
),
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FRTS
,
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
&
~
(
SAB82532_MODE_FCTS
),
&
info
->
regs
->
rw
.
mode
);
info
->
interrupt_mask1
&=
~
(
SAB82532_IMR1_CSC
);
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
}
else
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
&
~
(
SAB82532_MODE_FRTS
),
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FCTS
,
&
info
->
regs
->
rw
.
mode
);
info
->
interrupt_mask1
|=
SAB82532_IMR1_CSC
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
}
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RAC
,
&
info
->
regs
->
rw
.
mode
);
restore_flags
(
flags
);
}
static
void
sab82532_put_char
(
struct
tty_struct
*
tty
,
unsigned
char
ch
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
unsigned
long
flags
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_put_char"
))
return
;
if
(
!
tty
||
!
info
->
xmit
.
buf
)
return
;
save_flags
(
flags
);
cli
();
if
(
!
CIRC_SPACE
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
))
{
restore_flags
(
flags
);
return
;
}
info
->
xmit
.
buf
[
info
->
xmit
.
head
]
=
ch
;
info
->
xmit
.
head
=
(
info
->
xmit
.
head
+
1
)
&
(
SERIAL_XMIT_SIZE
-
1
);
restore_flags
(
flags
);
}
static
void
sab82532_flush_chars
(
struct
tty_struct
*
tty
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
unsigned
long
flags
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_flush_chars"
))
return
;
if
((
info
->
xmit
.
head
==
info
->
xmit
.
tail
)
||
tty
->
stopped
||
tty
->
hw_stopped
||
!
info
->
xmit
.
buf
)
return
;
save_flags
(
flags
);
cli
();
info
->
interrupt_mask1
&=
~
(
SAB82532_IMR1_XPR
);
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
sab82532_start_tx
(
info
);
restore_flags
(
flags
);
}
static
int
sab82532_write
(
struct
tty_struct
*
tty
,
int
from_user
,
const
unsigned
char
*
buf
,
int
count
)
{
int
c
,
ret
=
0
;
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
unsigned
long
flags
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_write"
))
return
0
;
if
(
!
tty
||
!
info
->
xmit
.
buf
||
!
tmp_buf
)
return
0
;
save_flags
(
flags
);
if
(
from_user
)
{
down
(
&
tmp_buf_sem
);
while
(
1
)
{
int
c1
;
c
=
CIRC_SPACE_TO_END
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
);
if
(
count
<
c
)
c
=
count
;
if
(
c
<=
0
)
break
;
c
-=
copy_from_user
(
tmp_buf
,
buf
,
c
);
if
(
!
c
)
{
if
(
!
ret
)
ret
=
-
EFAULT
;
break
;
}
cli
();
c1
=
CIRC_SPACE_TO_END
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
);
if
(
c1
<
c
)
c
=
c1
;
memcpy
(
info
->
xmit
.
buf
+
info
->
xmit
.
head
,
tmp_buf
,
c
);
info
->
xmit
.
head
=
(
info
->
xmit
.
head
+
c
)
&
(
SERIAL_XMIT_SIZE
-
1
);
restore_flags
(
flags
);
buf
+=
c
;
count
-=
c
;
ret
+=
c
;
}
up
(
&
tmp_buf_sem
);
up
->
port
.
ignore_status_mask
|=
(
SAB82532_ISR0_RPF
|
SAB82532_ISR0_TCD
);
/* Now bang the new settings into the chip. */
sunsab_cec_wait
(
up
);
sunsab_tec_wait
(
up
);
writeb
(
dafo
,
&
up
->
regs
->
w
.
dafo
);
writeb
(
ebrg
&
0xff
,
&
up
->
regs
->
w
.
bgr
);
writeb
((
readb
(
&
up
->
regs
->
rw
.
ccr2
)
&
~
0xc0
)
|
((
ebrg
>>
2
)
&
0xc0
),
&
up
->
regs
->
rw
.
ccr2
);
if
(
cflag
&
CRTSCTS
)
{
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
&
~
SAB82532_MODE_RTS
,
&
up
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FRTS
,
&
up
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
&
~
SAB82532_MODE_FCTS
,
&
up
->
regs
->
rw
.
mode
);
up
->
interrupt_mask1
&=
~
SAB82532_IMR1_CSC
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
}
else
{
cli
();
while
(
1
)
{
c
=
CIRC_SPACE_TO_END
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
);
if
(
count
<
c
)
c
=
count
;
if
(
c
<=
0
)
break
;
memcpy
(
info
->
xmit
.
buf
+
info
->
xmit
.
head
,
buf
,
c
);
info
->
xmit
.
head
=
(
info
->
xmit
.
head
+
c
)
&
(
SERIAL_XMIT_SIZE
-
1
);
buf
+=
c
;
count
-=
c
;
ret
+=
c
;
}
restore_flags
(
flags
);
}
if
((
info
->
xmit
.
head
!=
info
->
xmit
.
tail
)
&&
!
tty
->
stopped
&&
!
tty
->
hw_stopped
)
{
info
->
interrupt_mask1
&=
~
(
SAB82532_IMR1_XPR
);
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
sab82532_start_tx
(
info
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
up
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
&
~
SAB82532_MODE_FRTS
,
&
up
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FCTS
,
&
up
->
regs
->
rw
.
mode
);
up
->
interrupt_mask1
|=
SAB82532_IMR1_CSC
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
}
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RAC
,
&
up
->
regs
->
rw
.
mode
);
restore_flags
(
flags
);
return
ret
;
}
static
int
sab82532_write_room
(
struct
tty_struct
*
tty
)
/* port->lock is not held. */
static
void
sunsab_change_speed
(
struct
uart_port
*
port
,
unsigned
int
cflag
,
unsigned
int
iflag
,
unsigned
int
quot
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_write_room"
))
return
0
;
return
CIRC_SPACE
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
);
}
static
int
sab82532_chars_in_buffer
(
struct
tty_struct
*
tty
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_chars_in_buffer"
))
return
0
;
return
CIRC_CNT
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
);
}
static
void
sab82532_flush_buffer
(
struct
tty_struct
*
tty
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
struct
uart_sunsab_port
*
up
=
(
struct
uart_sunsab_port
*
)
port
;
unsigned
long
flags
;
int
baud
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_flush_buffer"
))
return
;
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
save_flags
(
flags
);
cli
();
info
->
xmit
.
head
=
info
->
xmit
.
tail
=
0
;
restore_flags
(
flags
);
/* Undo what generic UART core did. */
baud
=
(
SAB_BASE_BAUD
/
(
quot
*
16
));
wake_up_interruptible
(
&
tty
->
write_wait
);
if
((
tty
->
flags
&
(
1
<<
TTY_DO_WRITE_WAKEUP
))
&&
tty
->
ldisc
.
write_wakeup
)
(
tty
->
ldisc
.
write_wakeup
)(
tty
);
}
sunsab_convert_to_sab
(
up
,
cflag
,
iflag
,
baud
);
/*
* This function is used to send a high-priority XON/XOFF character to
* the device
*/
static
void
sab82532_send_xchar
(
struct
tty_struct
*
tty
,
char
ch
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
unsigned
long
flags
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_send_xchar"
))
return
;
save_flags
(
flags
);
cli
();
sab82532_tec_wait
(
info
);
writeb
(
ch
,
&
info
->
regs
->
w
.
tic
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
}
/*
* ------------------------------------------------------------
* sab82532_throttle()
*
* This routine is called by the upper-layer tty layer to signal that
* incoming characters should be throttled.
* ------------------------------------------------------------
*/
static
void
sab82532_throttle
(
struct
tty_struct
*
tty
)
static
const
char
*
sunsab_type
(
struct
uart_port
*
port
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
#ifdef SERIAL_DEBUG_THROTTLE
char
buf
[
64
];
printk
(
"throttle %s: %d....
\n
"
,
_tty_name
(
tty
,
buf
),
tty
->
ldisc
.
chars_in_buffer
(
tty
));
#endif
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_throttle"
))
return
;
if
(
I_IXOFF
(
tty
))
sab82532_send_xchar
(
tty
,
STOP_CHAR
(
tty
));
if
(
tty
->
termios
->
c_cflag
&
CRTSCTS
)
{
u8
mode
=
readb
(
&
info
->
regs
->
r
.
mode
);
mode
&=
~
(
SAB82532_MODE_FRTS
|
SAB82532_MODE_RTS
);
writeb
(
mode
,
&
info
->
regs
->
w
.
mode
);
}
return
"SunSAB"
;
}
static
void
s
ab82532_unthrottle
(
struct
tty_struct
*
tty
)
static
void
s
unsab_release_port
(
struct
uart_port
*
port
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
#ifdef SERIAL_DEBUG_THROTTLE
char
buf
[
64
];
printk
(
"unthrottle %s: %d....
\n
"
,
_tty_name
(
tty
,
buf
),
tty
->
ldisc
.
chars_in_buffer
(
tty
));
#endif
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_unthrottle"
))
return
;
if
(
I_IXOFF
(
tty
))
{
if
(
info
->
x_char
)
info
->
x_char
=
0
;
else
sab82532_send_xchar
(
tty
,
START_CHAR
(
tty
));
}
if
(
tty
->
termios
->
c_cflag
&
CRTSCTS
)
{
u8
mode
=
readb
(
&
info
->
regs
->
r
.
mode
);
mode
&=
~
(
SAB82532_MODE_RTS
);
mode
|=
SAB82532_MODE_FRTS
;
writeb
(
mode
,
&
info
->
regs
->
w
.
mode
);
}
}
/*
* ------------------------------------------------------------
* sab82532_ioctl() and friends
* ------------------------------------------------------------
*/
static
int
get_serial_info
(
struct
sab82532
*
info
,
struct
serial_struct
*
retinfo
)
static
int
sunsab_request_port
(
struct
uart_port
*
port
)
{
struct
serial_struct
tmp
;
if
(
!
retinfo
)
return
-
EFAULT
;
memset
(
&
tmp
,
0
,
sizeof
(
tmp
));
tmp
.
type
=
info
->
type
;
tmp
.
line
=
info
->
line
;
tmp
.
port
=
(
unsigned
long
)
info
->
regs
;
tmp
.
irq
=
info
->
irq
;
tmp
.
flags
=
info
->
flags
;
tmp
.
xmit_fifo_size
=
info
->
xmit_fifo_size
;
tmp
.
baud_base
=
info
->
baud_base
;
tmp
.
close_delay
=
info
->
close_delay
;
tmp
.
closing_wait
=
info
->
closing_wait
;
tmp
.
custom_divisor
=
info
->
custom_divisor
;
tmp
.
hub6
=
0
;
if
(
copy_to_user
(
retinfo
,
&
tmp
,
sizeof
(
*
retinfo
)))
return
-
EFAULT
;
return
0
;
}
static
int
set_serial_info
(
struct
sab82532
*
info
,
struct
serial_struct
*
new_info
)
static
void
sunsab_config_port
(
struct
uart_port
*
port
,
int
flags
)
{
return
0
;
}
/*
* get_lsr_info - get line status register info
*
* Purpose: Let user call ioctl() to get info when the UART physically
* is emptied. On bus types like RS485, the transmitter must
* release the bus after transmitting. This must be done when
* the transmit shift register is empty, not be done when the
* transmit holding register is empty. This functionality
* allows an RS485 driver to be written in user space.
*/
static
int
get_lsr_info
(
struct
sab82532
*
info
,
unsigned
int
*
value
)
static
int
sunsab_verify_port
(
struct
uart_port
*
port
,
struct
serial_struct
*
ser
)
{
unsigned
int
result
;
result
=
(
!
info
->
xmit
.
buf
&&
test_bit
(
SAB82532_ALLS
,
&
info
->
irqflags
))
?
TIOCSER_TEMT
:
0
;
return
put_user
(
result
,
value
);
return
-
EINVAL
;
}
static
struct
uart_ops
sunsab_pops
=
{
.
tx_empty
=
sunsab_tx_empty
,
.
set_mctrl
=
sunsab_set_mctrl
,
.
get_mctrl
=
sunsab_get_mctrl
,
.
stop_tx
=
sunsab_stop_tx
,
.
start_tx
=
sunsab_start_tx
,
.
send_xchar
=
sunsab_send_xchar
,
.
stop_rx
=
sunsab_stop_rx
,
.
enable_ms
=
sunsab_enable_ms
,
.
break_ctl
=
sunsab_break_ctl
,
.
startup
=
sunsab_startup
,
.
shutdown
=
sunsab_shutdown
,
.
change_speed
=
sunsab_change_speed
,
.
type
=
sunsab_type
,
.
release_port
=
sunsab_release_port
,
.
request_port
=
sunsab_request_port
,
.
config_port
=
sunsab_config_port
,
.
verify_port
=
sunsab_verify_port
,
};
static
int
get_modem_info
(
struct
sab82532
*
info
,
unsigned
int
*
value
)
{
unsigned
int
result
;
result
=
((
readb
(
&
info
->
regs
->
r
.
mode
)
&
SAB82532_MODE_RTS
)
?
((
readb
(
&
info
->
regs
->
r
.
mode
)
&
SAB82532_MODE_FRTS
)
?
0
:
TIOCM_RTS
)
:
TIOCM_RTS
)
|
((
readb
(
&
info
->
regs
->
r
.
pvr
)
&
info
->
pvr_dtr_bit
)
?
0
:
TIOCM_DTR
)
|
((
readb
(
&
info
->
regs
->
r
.
vstr
)
&
SAB82532_VSTR_CD
)
?
0
:
TIOCM_CAR
)
|
((
readb
(
&
info
->
regs
->
r
.
pvr
)
&
info
->
pvr_dsr_bit
)
?
0
:
TIOCM_DSR
)
|
((
readb
(
&
info
->
regs
->
r
.
star
)
&
SAB82532_STAR_CTS
)
?
TIOCM_CTS
:
0
);
return
put_user
(
result
,
value
);
}
static
struct
uart_driver
sunsab_reg
=
{
.
owner
=
THIS_MODULE
,
.
driver_name
=
"serial"
,
#ifdef CONFIG_DEVFS_FS
.
dev_name
=
"tts/%d"
,
#else
.
dev_name
=
"ttyS"
,
#endif
.
major
=
TTY_MAJOR
,
};
static
int
set_modem_info
(
struct
sab82532
*
info
,
unsigned
int
cmd
,
unsigned
int
*
value
)
{
unsigned
int
arg
;
if
(
get_user
(
arg
,
value
))
return
-
EFAULT
;
switch
(
cmd
)
{
case
TIOCMBIS
:
if
(
arg
&
TIOCM_RTS
)
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
&
~
(
SAB82532_MODE_FRTS
),
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
info
->
regs
->
rw
.
mode
);
}
if
(
arg
&
TIOCM_DTR
)
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
pvr
)
&
~
(
info
->
pvr_dtr_bit
),
&
info
->
regs
->
rw
.
pvr
);
}
break
;
case
TIOCMBIC
:
if
(
arg
&
TIOCM_RTS
)
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FRTS
,
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
info
->
regs
->
rw
.
mode
);
}
if
(
arg
&
TIOCM_DTR
)
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
pvr
)
|
info
->
pvr_dtr_bit
,
&
info
->
regs
->
rw
.
pvr
);
}
break
;
case
TIOCMSET
:
if
(
arg
&
TIOCM_RTS
)
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
&
~
(
SAB82532_MODE_FRTS
),
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
info
->
regs
->
rw
.
mode
);
}
else
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FRTS
,
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
info
->
regs
->
rw
.
mode
);
}
if
(
arg
&
TIOCM_DTR
)
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
pvr
)
&
~
(
info
->
pvr_dtr_bit
),
&
info
->
regs
->
rw
.
pvr
);
}
else
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
pvr
)
|
info
->
pvr_dtr_bit
,
&
info
->
regs
->
rw
.
pvr
);
}
break
;
default:
return
-
EINVAL
;
}
return
0
;
}
static
struct
uart_sunsab_port
*
sunsab_ports
;
static
int
num_channels
;
/*
* This routine sends a break character out the serial port.
*/
static
void
sab82532_break
(
struct
tty_struct
*
tty
,
int
break_state
)
static
__inline__
void
sunsab_console_putchar
(
struct
uart_sunsab_port
*
up
,
char
c
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
unsigned
long
flags
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_break"
))
return
;
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
if
(
!
info
->
regs
)
return
;
sunsab_tec_wait
(
up
);
writeb
(
c
,
&
up
->
regs
->
w
.
tic
)
;
#ifdef SERIAL_DEBUG_SEND_BREAK
printk
(
"sab82532_break(%d) jiff=%lu..."
,
break_state
,
jiffies
);
#endif
save_flags
(
flags
);
cli
();
if
(
break_state
==
-
1
)
writeb
(
readb
(
&
info
->
regs
->
rw
.
dafo
)
|
SAB82532_DAFO_XBRK
,
&
info
->
regs
->
rw
.
dafo
);
else
writeb
(
readb
(
&
info
->
regs
->
rw
.
dafo
)
&
~
(
SAB82532_DAFO_XBRK
),
&
info
->
regs
->
rw
.
dafo
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
}
static
int
sab82532_ioctl
(
struct
tty_struct
*
tty
,
struct
file
*
file
,
unsigned
int
cmd
,
unsigned
long
arg
)
static
void
sunsab_console_write
(
struct
console
*
con
,
const
char
*
s
,
unsigned
n
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
struct
async_icount
cprev
,
cnow
;
/* kernel counter temps */
struct
serial_icounter_struct
*
p_cuser
;
/* user space */
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_ioctl"
))
return
-
ENODEV
;
struct
uart_sunsab_port
*
up
=
&
sunsab_ports
[
con
->
index
];
int
i
;
if
((
cmd
!=
TIOCGSERIAL
)
&&
(
cmd
!=
TIOCSSERIAL
)
&&
(
cmd
!=
TIOCSERCONFIG
)
&&
(
cmd
!=
TIOCSERGWILD
)
&&
(
cmd
!=
TIOCSERSWILD
)
&&
(
cmd
!=
TIOCSERGSTRUCT
)
&&
(
cmd
!=
TIOCMIWAIT
)
&&
(
cmd
!=
TIOCGICOUNT
))
{
if
(
tty
->
flags
&
(
1
<<
TTY_IO_ERROR
))
return
-
EIO
;
for
(
i
=
0
;
i
<
n
;
i
++
)
{
if
(
*
s
==
'\n'
)
sunsab_console_putchar
(
up
,
'\r'
);
sunsab_console_putchar
(
up
,
*
s
++
);
}
switch
(
cmd
)
{
case
TIOCGSOFTCAR
:
return
put_user
(
C_CLOCAL
(
tty
)
?
1
:
0
,
(
int
*
)
arg
);
case
TIOCSSOFTCAR
:
if
(
get_user
(
arg
,
(
unsigned
int
*
)
arg
))
return
-
EFAULT
;
tty
->
termios
->
c_cflag
=
((
tty
->
termios
->
c_cflag
&
~
CLOCAL
)
|
(
arg
?
CLOCAL
:
0
));
return
0
;
case
TIOCMGET
:
return
get_modem_info
(
info
,
(
unsigned
int
*
)
arg
);
case
TIOCMBIS
:
case
TIOCMBIC
:
case
TIOCMSET
:
return
set_modem_info
(
info
,
cmd
,
(
unsigned
int
*
)
arg
);
case
TIOCGSERIAL
:
return
get_serial_info
(
info
,
(
struct
serial_struct
*
)
arg
);
case
TIOCSSERIAL
:
return
set_serial_info
(
info
,
(
struct
serial_struct
*
)
arg
);
case
TIOCSERGETLSR
:
/* Get line status register */
return
get_lsr_info
(
info
,
(
unsigned
int
*
)
arg
);
case
TIOCSERGSTRUCT
:
if
(
copy_to_user
((
struct
sab82532
*
)
arg
,
info
,
sizeof
(
struct
sab82532
)))
return
-
EFAULT
;
return
0
;
/*
* Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
* - mask passed in arg for lines of interest
* (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
* Caller should use TIOCGICOUNT to see which one it was
*/
case
TIOCMIWAIT
:
cli
();
/* note the counters on entry */
cprev
=
info
->
icount
;
sti
();
while
(
1
)
{
interruptible_sleep_on
(
&
info
->
delta_msr_wait
);
/* see if a signal did it */
if
(
signal_pending
(
current
))
return
-
ERESTARTSYS
;
cli
();
cnow
=
info
->
icount
;
/* atomic copy */
sti
();
if
(
cnow
.
rng
==
cprev
.
rng
&&
cnow
.
dsr
==
cprev
.
dsr
&&
cnow
.
dcd
==
cprev
.
dcd
&&
cnow
.
cts
==
cprev
.
cts
)
return
-
EIO
;
/* no change => error */
if
(
((
arg
&
TIOCM_RNG
)
&&
(
cnow
.
rng
!=
cprev
.
rng
))
||
((
arg
&
TIOCM_DSR
)
&&
(
cnow
.
dsr
!=
cprev
.
dsr
))
||
((
arg
&
TIOCM_CD
)
&&
(
cnow
.
dcd
!=
cprev
.
dcd
))
||
((
arg
&
TIOCM_CTS
)
&&
(
cnow
.
cts
!=
cprev
.
cts
))
)
{
return
0
;
}
cprev
=
cnow
;
}
/* NOTREACHED */
/*
* Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
* Return: write counters to the user passed counter struct
* NB: both 1->0 and 0->1 transitions are counted except for
* RI where only 0->1 is counted.
*/
case
TIOCGICOUNT
:
cli
();
cnow
=
info
->
icount
;
sti
();
p_cuser
=
(
struct
serial_icounter_struct
*
)
arg
;
if
(
put_user
(
cnow
.
cts
,
&
p_cuser
->
cts
)
||
put_user
(
cnow
.
dsr
,
&
p_cuser
->
dsr
)
||
put_user
(
cnow
.
rng
,
&
p_cuser
->
rng
)
||
put_user
(
cnow
.
dcd
,
&
p_cuser
->
dcd
))
return
-
EFAULT
;
return
0
;
default:
return
-
ENOIOCTLCMD
;
}
return
0
;
sunsab_tec_wait
(
up
);
}
static
void
sab82532_set_termios
(
struct
tty_struct
*
tty
,
struct
termios
*
old_termios
)
static
kdev_t
sunsab_console_device
(
struct
console
*
con
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
if
(
(
tty
->
termios
->
c_cflag
==
old_termios
->
c_cflag
)
&&
(
RELEVANT_IFLAG
(
tty
->
termios
->
c_iflag
)
==
RELEVANT_IFLAG
(
old_termios
->
c_iflag
)))
return
;
change_speed
(
info
);
/* Handle transition to B0 status */
if
((
old_termios
->
c_cflag
&
CBAUD
)
&&
!
(
tty
->
termios
->
c_cflag
&
CBAUD
))
{
writeb
(
readb
(
&
info
->
regs
->
w
.
mode
)
|
SAB82532_MODE_FRTS
,
&
info
->
regs
->
w
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
w
.
mode
)
|
SAB82532_MODE_RTS
,
&
info
->
regs
->
w
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
w
.
pvr
)
|
info
->
pvr_dtr_bit
,
&
info
->
regs
->
w
.
pvr
);
}
/* Handle transition away from B0 status */
if
(
!
(
old_termios
->
c_cflag
&
CBAUD
)
&&
(
tty
->
termios
->
c_cflag
&
CBAUD
))
{
writeb
(
readb
(
&
info
->
regs
->
w
.
pvr
)
&
~
(
info
->
pvr_dtr_bit
),
&
info
->
regs
->
w
.
pvr
);
if
(
tty
->
termios
->
c_cflag
&
CRTSCTS
)
{
writeb
(
readb
(
&
info
->
regs
->
w
.
mode
)
&
~
(
SAB82532_MODE_RTS
),
&
info
->
regs
->
w
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
w
.
mode
)
|
SAB82532_MODE_FRTS
,
&
info
->
regs
->
w
.
mode
);
}
else
if
(
test_bit
(
TTY_THROTTLED
,
&
tty
->
flags
))
{
writeb
(
readb
(
&
info
->
regs
->
w
.
mode
)
&
~
(
SAB82532_MODE_FRTS
|
SAB82532_MODE_RTS
),
&
info
->
regs
->
w
.
mode
);
}
else
{
writeb
(
readb
(
&
info
->
regs
->
w
.
mode
)
&
~
(
SAB82532_MODE_FRTS
),
&
info
->
regs
->
w
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
w
.
mode
)
|
SAB82532_MODE_RTS
,
&
info
->
regs
->
w
.
mode
);
}
}
/* Handle turning off CRTSCTS */
if
((
old_termios
->
c_cflag
&
CRTSCTS
)
&&
!
(
tty
->
termios
->
c_cflag
&
CRTSCTS
))
{
tty
->
hw_stopped
=
0
;
sab82532_start
(
tty
);
}
return
mk_kdev
(
sunsab_reg
.
major
,
sunsab_reg
.
minor
+
con
->
index
);
}
/*
* ------------------------------------------------------------
* sab82532_close()
*
* This routine is called when the serial port gets closed. First, we
* wait for the last remaining data to be sent. Then, we unlink its
* async structure from the interrupt chain if necessary, and we free
* that IRQ if nothing is left in the chain.
* ------------------------------------------------------------
*/
static
void
sab82532_close
(
struct
tty_struct
*
tty
,
struct
file
*
filp
)
static
int
sunsab_console_setup
(
struct
console
*
con
,
char
*
options
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
struct
uart_sunsab_port
*
up
=
&
sunsab_ports
[
con
->
index
]
;
unsigned
long
flags
;
int
baud
;
if
(
!
info
||
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_close"
))
return
;
save_flags
(
flags
);
cli
();
printk
(
"Console: ttyS%d (SAB82532)
\n
"
,
(
sunsab_reg
.
minor
-
64
)
+
con
->
index
);
if
(
tty_hung_up_p
(
filp
))
{
MOD_DEC_USE_COUNT
;
restore_flags
(
flags
);
return
;
}
sunserial_console_termios
(
con
);
#ifdef SERIAL_DEBUG_OPEN
printk
(
"sab82532_close ttys%d, count = %d
\n
"
,
info
->
line
,
info
->
count
);
#endif
if
((
tty
->
count
==
1
)
&&
(
info
->
count
!=
1
))
{
/*
* Uh, oh. tty->count is 1, which means that the tty
* structure will be freed. info->count should always
* be one in these conditions. If it's greater than
* one, we've got real problems, since it means the
* serial port won't be shutdown.
*/
printk
(
"sab82532_close: bad serial port count; tty->count is 1,"
" info->count is %d
\n
"
,
info
->
count
);
info
->
count
=
1
;
}
if
(
--
info
->
count
<
0
)
{
printk
(
"sab82532_close: bad serial port count for ttys%d: %d
\n
"
,
info
->
line
,
info
->
count
);
info
->
count
=
0
;
}
if
(
info
->
count
)
{
MOD_DEC_USE_COUNT
;
restore_flags
(
flags
);
return
;
}
info
->
flags
|=
ASYNC_CLOSING
;
/*
* Save the termios structure, since this port may have
* separate termios for callout and dialin.
*/
if
(
info
->
flags
&
ASYNC_NORMAL_ACTIVE
)
info
->
normal_termios
=
*
tty
->
termios
;
if
(
info
->
flags
&
ASYNC_CALLOUT_ACTIVE
)
info
->
callout_termios
=
*
tty
->
termios
;
/*
* Now we wait for the transmit buffer to clear; and we notify
* the line discipline to only process XON/XOFF characters.
/* Firmware console speed is limited to 150-->38400 baud so
* this hackish cflag thing is OK.
*/
tty
->
closing
=
1
;
if
(
info
->
closing_wait
!=
ASYNC_CLOSING_WAIT_NONE
)
tty_wait_until_sent
(
tty
,
info
->
closing_wait
);
switch
(
con
->
cflag
&
CBAUD
)
{
case
B150
:
baud
=
150
;
break
;
case
B300
:
baud
=
300
;
break
;
case
B600
:
baud
=
600
;
break
;
case
B1200
:
baud
=
1200
;
break
;
case
B2400
:
baud
=
2400
;
break
;
case
B4800
:
baud
=
4800
;
break
;
default:
case
B9600
:
baud
=
9600
;
break
;
case
B19200
:
baud
=
19200
;
break
;
case
B38400
:
baud
=
38400
;
break
;
};
/*
* At this point we stop accepting input. To do this, we
* disable the receive line status interrupts, and turn off
* the receiver.
* Temporary fix.
*/
info
->
interrupt_mask0
|=
SAB82532_IMR0_TCD
;
writeb
(
info
->
interrupt_mask0
,
&
info
->
regs
->
w
.
imr0
);
if
(
info
->
flags
&
ASYNC_INITIALIZED
)
{
/*
* Before we drop DTR, make sure the UART transmitter
* has completely drained; this is especially
* important if there is a transmit FIFO!
*/
sab82532_wait_until_sent
(
tty
,
info
->
timeout
);
}
shutdown
(
info
);
if
(
tty
->
driver
.
flush_buffer
)
tty
->
driver
.
flush_buffer
(
tty
);
if
(
tty
->
ldisc
.
flush_buffer
)
tty
->
ldisc
.
flush_buffer
(
tty
);
tty
->
closing
=
0
;
info
->
event
=
0
;
info
->
tty
=
0
;
if
(
info
->
blocked_open
)
{
if
(
info
->
close_delay
)
{
current
->
state
=
TASK_INTERRUPTIBLE
;
schedule_timeout
(
info
->
close_delay
);
}
wake_up_interruptible
(
&
info
->
open_wait
);
}
info
->
flags
&=
~
(
ASYNC_NORMAL_ACTIVE
|
ASYNC_CALLOUT_ACTIVE
|
ASYNC_CLOSING
);
wake_up_interruptible
(
&
info
->
close_wait
);
MOD_DEC_USE_COUNT
;
restore_flags
(
flags
);
}
/*
* sab82532_wait_until_sent() --- wait until the transmitter is empty
*/
static
void
sab82532_wait_until_sent
(
struct
tty_struct
*
tty
,
int
timeout
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
unsigned
long
orig_jiffies
,
char_time
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_wait_until_sent"
))
return
;
spin_lock_init
(
&
up
->
port
.
lock
);
/*
* Set the check interval to be 1/5 of the estimated time to
* send a single character, and make it at least 1. The check
* interval should also be less than the timeout.
*
* Note: we have to use pretty tight timings here to satisfy
* the NIST-PCTS.
* Initialize the hardware
*/
char_time
=
(
info
->
timeout
-
HZ
/
50
)
/
info
->
xmit_fifo_size
;
char_time
=
char_time
/
5
;
if
(
char_time
==
0
)
char_time
=
1
;
if
(
timeout
)
char_time
=
MIN
(
char_time
,
timeout
);
#ifdef SERIAL_DEBUG_WAIT_UNTIL_SENT
printk
(
"In sab82532_wait_until_sent(%d) check=%lu "
"xmit_cnt = %ld, alls = %d (jiff=%lu)...
\n
"
,
timeout
,
char_time
,
CIRC_CNT
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
),
test_bit
(
SAB82532_ALLS
,
&
info
->
irqflags
),
jiffies
);
#endif
orig_jiffies
=
jiffies
;
while
((
info
->
xmit
.
head
!=
info
->
xmit
.
tail
)
||
!
test_bit
(
SAB82532_ALLS
,
&
info
->
irqflags
))
{
current
->
state
=
TASK_INTERRUPTIBLE
;
schedule_timeout
(
char_time
);
if
(
signal_pending
(
current
))
break
;
if
(
timeout
&&
time_after
(
jiffies
,
orig_jiffies
+
timeout
))
break
;
}
#ifdef SERIAL_DEBUG_WAIT_UNTIL_SENT
printk
(
"xmit_cnt = %ld, alls = %d (jiff=%lu)...done
\n
"
,
CIRC_CNT
(
info
->
xmit
.
head
,
info
->
xmit
.
tail
,
SERIAL_XMIT_SIZE
),
test_bit
(
SAB82532_ALLS
,
&
info
->
irqflags
),
jiffies
);
#endif
}
/*
* sab82532_hangup() --- called by tty_hangup() when a hangup is signaled.
*/
static
void
sab82532_hangup
(
struct
tty_struct
*
tty
)
{
struct
sab82532
*
info
=
(
struct
sab82532
*
)
tty
->
driver_data
;
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_hangup"
))
return
;
#ifdef CONFIG_SERIAL_CONSOLE
if
(
info
->
is_console
)
return
;
#endif
sab82532_flush_buffer
(
tty
);
shutdown
(
info
);
info
->
event
=
0
;
info
->
count
=
0
;
info
->
flags
&=
~
(
ASYNC_NORMAL_ACTIVE
|
ASYNC_CALLOUT_ACTIVE
);
info
->
tty
=
0
;
wake_up_interruptible
(
&
info
->
open_wait
);
}
sunsab_startup
(
&
up
->
port
);
/*
* ------------------------------------------------------------
* sab82532_open() and friends
* ------------------------------------------------------------
*/
static
int
block_til_ready
(
struct
tty_struct
*
tty
,
struct
file
*
filp
,
struct
sab82532
*
info
)
{
DECLARE_WAITQUEUE
(
wait
,
current
);
int
retval
;
int
do_clocal
=
0
;
spin_lock_irqsave
(
&
up
->
port
.
lock
,
flags
);
/*
* If the device is in the middle of being closed, then block
* until it's done, and then try again.
* Finally, enable interrupts
*/
if
(
tty_hung_up_p
(
filp
)
||
(
info
->
flags
&
ASYNC_CLOSING
))
{
if
(
info
->
flags
&
ASYNC_CLOSING
)
interruptible_sleep_on
(
&
info
->
close_wait
);
#ifdef SERIAL_DO_RESTART
if
(
info
->
flags
&
ASYNC_HUP_NOTIFY
)
return
-
EAGAIN
;
else
return
-
ERESTARTSYS
;
#else
return
-
EAGAIN
;
#endif
}
up
->
interrupt_mask0
=
SAB82532_IMR0_PERR
|
SAB82532_IMR0_FERR
|
SAB82532_IMR0_PLLA
|
SAB82532_IMR0_CDSC
;
writeb
(
up
->
interrupt_mask0
,
&
up
->
regs
->
w
.
imr0
);
up
->
interrupt_mask1
=
SAB82532_IMR1_BRKT
|
SAB82532_IMR1_ALLS
|
SAB82532_IMR1_XOFF
|
SAB82532_IMR1_TIN
|
SAB82532_IMR1_CSC
|
SAB82532_IMR1_XON
|
SAB82532_IMR1_XPR
;
writeb
(
up
->
interrupt_mask1
,
&
up
->
regs
->
w
.
imr1
);
/*
* If this is a callout device, then just make sure the normal
* device isn't being used.
*/
if
(
tty
->
driver
.
subtype
==
SERIAL_TYPE_CALLOUT
)
{
if
(
info
->
flags
&
ASYNC_NORMAL_ACTIVE
)
return
-
EBUSY
;
if
((
info
->
flags
&
ASYNC_CALLOUT_ACTIVE
)
&&
(
info
->
flags
&
ASYNC_SESSION_LOCKOUT
)
&&
(
info
->
session
!=
current
->
session
))
return
-
EBUSY
;
if
((
info
->
flags
&
ASYNC_CALLOUT_ACTIVE
)
&&
(
info
->
flags
&
ASYNC_PGRP_LOCKOUT
)
&&
(
info
->
pgrp
!=
current
->
pgrp
))
return
-
EBUSY
;
info
->
flags
|=
ASYNC_CALLOUT_ACTIVE
;
return
0
;
}
/*
* If non-blocking mode is set, or the port is not enabled,
* then make the check up front and then exit.
*/
if
((
filp
->
f_flags
&
O_NONBLOCK
)
||
(
tty
->
flags
&
(
1
<<
TTY_IO_ERROR
)))
{
if
(
info
->
flags
&
ASYNC_CALLOUT_ACTIVE
)
return
-
EBUSY
;
info
->
flags
|=
ASYNC_NORMAL_ACTIVE
;
return
0
;
}
sunsab_convert_to_sab
(
up
,
con
->
cflag
,
0
,
baud
);
if
(
info
->
flags
&
ASYNC_CALLOUT_ACTIVE
)
{
if
(
info
->
normal_termios
.
c_cflag
&
CLOCAL
)
do_clocal
=
1
;
}
else
{
if
(
tty
->
termios
->
c_cflag
&
CLOCAL
)
do_clocal
=
1
;
}
spin_unlock_irqrestore
(
&
up
->
port
.
lock
,
flags
);
/*
* Block waiting for the carrier detect and the line to become
* free (i.e., not in use by the callout). While we are in
* this loop, info->count is dropped by one, so that
* sab82532_close() knows when to free things. We restore it upon
* exit, either normal or abnormal.
*/
retval
=
0
;
add_wait_queue
(
&
info
->
open_wait
,
&
wait
);
#ifdef SERIAL_DEBUG_OPEN
printk
(
"block_til_ready before block: ttyS%d, count = %d
\n
"
,
info
->
line
,
info
->
count
);
#endif
cli
();
if
(
!
tty_hung_up_p
(
filp
))
info
->
count
--
;
sti
();
info
->
blocked_open
++
;
while
(
1
)
{
cli
();
if
(
!
(
info
->
flags
&
ASYNC_CALLOUT_ACTIVE
)
&&
(
tty
->
termios
->
c_cflag
&
CBAUD
))
{
writeb
(
readb
(
&
info
->
regs
->
rw
.
pvr
)
&
~
(
info
->
pvr_dtr_bit
),
&
info
->
regs
->
rw
.
pvr
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FRTS
,
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
&
~
(
SAB82532_MODE_RTS
),
&
info
->
regs
->
rw
.
mode
);
}
sti
();
set_current_state
(
TASK_INTERRUPTIBLE
);
if
(
tty_hung_up_p
(
filp
)
||
!
(
info
->
flags
&
ASYNC_INITIALIZED
))
{
#ifdef SERIAL_DO_RESTART
if
(
info
->
flags
&
ASYNC_HUP_NOTIFY
)
retval
=
-
EAGAIN
;
else
retval
=
-
ERESTARTSYS
;
#else
retval
=
-
EAGAIN
;
#endif
break
;
}
if
(
!
(
info
->
flags
&
ASYNC_CALLOUT_ACTIVE
)
&&
!
(
info
->
flags
&
ASYNC_CLOSING
)
&&
(
do_clocal
||
!
(
readb
(
&
info
->
regs
->
r
.
vstr
)
&
SAB82532_VSTR_CD
)))
break
;
if
(
signal_pending
(
current
))
{
retval
=
-
ERESTARTSYS
;
break
;
}
#ifdef SERIAL_DEBUG_OPEN
printk
(
"block_til_ready blocking: ttyS%d, count = %d, flags = %x, clocal = %d, vstr = %02x
\n
"
,
info
->
line
,
info
->
count
,
info
->
flags
,
do_clocal
,
readb
(
&
info
->
regs
->
r
.
vstr
));
#endif
schedule
();
}
current
->
state
=
TASK_RUNNING
;
remove_wait_queue
(
&
info
->
open_wait
,
&
wait
);
if
(
!
tty_hung_up_p
(
filp
))
info
->
count
++
;
info
->
blocked_open
--
;
#ifdef SERIAL_DEBUG_OPEN
printk
(
"block_til_ready after blocking: ttys%d, count = %d
\n
"
,
info
->
line
,
info
->
count
);
#endif
if
(
retval
)
return
retval
;
info
->
flags
|=
ASYNC_NORMAL_ACTIVE
;
return
0
;
}
/*
* This routine is called whenever a serial port is opened. It
* enables interrupts for a serial port, linking in its async structure into
* the IRQ chain. It also performs the serial-specific
* initialization for the tty structure.
*/
static
int
sab82532_open
(
struct
tty_struct
*
tty
,
struct
file
*
filp
)
{
struct
sab82532
*
info
=
sab82532_chain
;
int
retval
,
line
;
unsigned
long
page
;
#ifdef SERIAL_DEBUG_OPEN
printk
(
"sab82532_open: count = %d
\n
"
,
info
->
count
);
#endif
line
=
minor
(
tty
->
device
)
-
tty
->
driver
.
minor_start
;
if
((
line
<
0
)
||
(
line
>=
NR_PORTS
))
return
-
ENODEV
;
while
(
info
)
{
if
(
info
->
line
==
line
)
break
;
info
=
info
->
next
;
}
if
(
!
info
)
{
printk
(
"sab82532_open: can't find info for line %d
\n
"
,
line
);
return
-
ENODEV
;
}
if
(
serial_paranoia_check
(
info
,
tty
->
device
,
"sab82532_open"
))
return
-
ENODEV
;
#ifdef SERIAL_DEBUG_OPEN
printk
(
"sab82532_open %s%d, count = %d
\n
"
,
tty
->
driver
.
name
,
info
->
line
,
info
->
count
);
#endif
if
(
!
tmp_buf
)
{
page
=
get_free_page
(
GFP_KERNEL
);
if
(
!
page
)
return
-
ENOMEM
;
if
(
tmp_buf
)
free_page
(
page
);
else
tmp_buf
=
(
unsigned
char
*
)
page
;
}
info
->
count
++
;
tty
->
driver_data
=
info
;
info
->
tty
=
tty
;
/*
* If the port is in the middle of closing, bail out now.
*/
if
(
tty_hung_up_p
(
filp
)
||
(
info
->
flags
&
ASYNC_CLOSING
))
{
if
(
info
->
flags
&
ASYNC_CLOSING
)
interruptible_sleep_on
(
&
info
->
close_wait
);
#ifdef SERIAL_DO_RESTART
return
((
info
->
flags
&
ASYNC_HUP_NOTIFY
)
?
-
EAGAIN
:
-
ERESTARTSYS
);
#else
return
-
EAGAIN
;
#endif
}
/*
* Start up serial port
*/
retval
=
startup
(
info
);
if
(
retval
)
return
retval
;
MOD_INC_USE_COUNT
;
retval
=
block_til_ready
(
tty
,
filp
,
info
);
if
(
retval
)
{
#ifdef SERIAL_DEBUG_OPEN
printk
(
"sab82532_open returning after block_til_ready with %d
\n
"
,
retval
);
#endif
return
retval
;
}
if
((
info
->
count
==
1
)
&&
(
info
->
flags
&
ASYNC_SPLIT_TERMIOS
))
{
if
(
tty
->
driver
.
subtype
==
SERIAL_TYPE_NORMAL
)
*
tty
->
termios
=
info
->
normal_termios
;
else
*
tty
->
termios
=
info
->
callout_termios
;
change_speed
(
info
);
}
#ifdef CONFIG_SERIAL_CONSOLE
if
(
sab82532_console
.
cflag
&&
sab82532_console
.
index
==
line
)
{
tty
->
termios
->
c_cflag
=
sab82532_console
.
cflag
;
sab82532_console
.
cflag
=
0
;
change_speed
(
info
);
}
#endif
info
->
session
=
current
->
session
;
info
->
pgrp
=
current
->
pgrp
;
#ifdef SERIAL_DEBUG_OPEN
printk
(
"sab82532_open ttys%d successful... count %d"
,
info
->
line
,
info
->
count
);
#endif
return
0
;
}
/*
* /proc fs routines....
*/
static
struct
console
sunsab_console
=
{
.
name
=
"ttyS"
,
.
write
=
sunsab_console_write
,
.
device
=
sunsab_console_device
,
.
setup
=
sunsab_console_setup
,
.
flags
=
CON_PRINTBUFFER
,
.
index
=
-
1
,
};
static
__inline__
int
line_info
(
char
*
buf
,
struct
sab82532
*
info
)
static
void
__init
sunsab_console_init
(
void
)
{
unsigned
long
flags
;
char
stat_buf
[
30
];
int
ret
;
int
i
;
ret
=
sprintf
(
buf
,
"%u: uart:SAB82532 "
,
info
->
line
);
switch
(
info
->
type
)
{
case
0
:
ret
+=
sprintf
(
buf
+
ret
,
"V1.0 "
);
break
;
case
1
:
ret
+=
sprintf
(
buf
+
ret
,
"V2.0 "
);
break
;
case
2
:
ret
+=
sprintf
(
buf
+
ret
,
"V3.2 "
);
break
;
default:
ret
+=
sprintf
(
buf
+
ret
,
"V?.? "
);
break
;
}
ret
+=
sprintf
(
buf
+
ret
,
"port:%lX irq:%s"
,
(
unsigned
long
)
info
->
regs
,
__irq_itoa
(
info
->
irq
));
if
(
con_is_present
())
return
;
if
(
!
info
->
regs
)
{
ret
+=
sprintf
(
buf
+
ret
,
"
\n
"
);
return
ret
;
}
for
(
i
=
0
;
i
<
num_channels
;
i
++
)
{
int
this_minor
=
sunsab_reg
.
minor
+
i
;
/*
* Figure out the current RS-232 lines
*/
stat_buf
[
0
]
=
0
;
stat_buf
[
1
]
=
0
;
save_flags
(
flags
);
cli
();
if
(
readb
(
&
info
->
regs
->
r
.
mode
)
&
SAB82532_MODE_RTS
)
{
if
(
!
(
readb
(
&
info
->
regs
->
r
.
mode
)
&
SAB82532_MODE_FRTS
))
strcat
(
stat_buf
,
"|RTS"
);
}
else
{
strcat
(
stat_buf
,
"|RTS"
);
if
((
this_minor
-
64
)
==
(
serial_console
-
1
))
break
;
}
if
(
readb
(
&
info
->
regs
->
r
.
star
)
&
SAB82532_STAR_CTS
)
strcat
(
stat_buf
,
"|CTS"
);
if
(
!
(
readb
(
&
info
->
regs
->
r
.
pvr
)
&
info
->
pvr_dtr_bit
))
strcat
(
stat_buf
,
"|DTR"
);
if
(
!
(
readb
(
&
info
->
regs
->
r
.
pvr
)
&
info
->
pvr_dsr_bit
))
strcat
(
stat_buf
,
"|DSR"
);
if
(
!
(
readb
(
&
info
->
regs
->
r
.
vstr
)
&
SAB82532_VSTR_CD
))
strcat
(
stat_buf
,
"|CD"
);
restore_flags
(
flags
);
if
(
info
->
baud
)
ret
+=
sprintf
(
buf
+
ret
,
" baud:%u"
,
info
->
baud
);
ret
+=
sprintf
(
buf
+
ret
,
" tx:%u rx:%u"
,
info
->
icount
.
tx
,
info
->
icount
.
rx
);
if
(
info
->
icount
.
frame
)
ret
+=
sprintf
(
buf
+
ret
,
" fe:%u"
,
info
->
icount
.
frame
);
if
(
info
->
icount
.
parity
)
ret
+=
sprintf
(
buf
+
ret
,
" pe:%u"
,
info
->
icount
.
parity
);
if
(
info
->
icount
.
brk
)
ret
+=
sprintf
(
buf
+
ret
,
" brk:%u"
,
info
->
icount
.
brk
);
if
(
info
->
icount
.
overrun
)
ret
+=
sprintf
(
buf
+
ret
,
" oe:%u"
,
info
->
icount
.
overrun
);
/*
* Last thing is the RS-232 status lines.
*/
ret
+=
sprintf
(
buf
+
ret
,
" %s
\n
"
,
stat_buf
+
1
);
return
ret
;
}
if
(
i
==
num_channels
)
return
;
int
sab82532_read_proc
(
char
*
page
,
char
**
start
,
off_t
off
,
int
count
,
int
*
eof
,
void
*
data
)
{
struct
sab82532
*
info
=
sab82532_chain
;
off_t
begin
=
0
;
int
len
=
0
;
len
+=
sprintf
(
page
,
"serinfo:1.0 driver:%s
\n
"
,
serial_version
);
for
(
info
=
sab82532_chain
;
info
&&
len
<
4000
;
info
=
info
->
next
)
{
len
+=
line_info
(
page
+
len
,
info
);
if
(
len
+
begin
>
off
+
count
)
goto
done
;
if
(
len
+
begin
<
off
)
{
begin
+=
len
;
len
=
0
;
}
}
*
eof
=
1
;
done:
if
(
off
>=
len
+
begin
)
return
0
;
*
start
=
page
+
(
off
-
begin
);
return
((
count
<
begin
+
len
-
off
)
?
count
:
begin
+
len
-
off
);
sunsab_console
.
index
=
i
;
register_console
(
&
sunsab_console
);
}
/*
* ---------------------------------------------------------------------
* sab82532_init() and friends
*
* sab82532_init() is called at boot-time to initialize the serial driver.
* ---------------------------------------------------------------------
*/
static
int
__init
get_sab82532
(
unsigned
long
*
memory_start
)
static
void
__init
for_each_sab_edev
(
void
(
*
callback
)(
struct
linux_ebus_device
*
,
void
*
),
void
*
arg
)
{
struct
linux_ebus
*
ebus
;
struct
linux_ebus_device
*
edev
=
0
;
struct
sab82532
*
sab
;
unsigned
long
regs
,
offset
;
int
i
;
struct
linux_ebus_device
*
edev
=
NULL
;
for_each_ebus
(
ebus
)
{
for_each_ebusdev
(
edev
,
ebus
)
{
if
(
!
strcmp
(
edev
->
prom_name
,
"se"
))
goto
ebus_done
;
if
(
!
strcmp
(
edev
->
prom_name
,
"serial"
))
{
if
(
!
strcmp
(
edev
->
prom_name
,
"se"
))
{
callback
(
edev
,
arg
)
;
continue
;
}
else
if
(
!
strcmp
(
edev
->
prom_name
,
"serial"
))
{
char
compat
[
32
];
int
clen
;
...
...
@@ -2136,481 +988,183 @@ static int __init get_sab82532(unsigned long *memory_start)
compat
,
sizeof
(
compat
));
if
(
clen
>
0
)
{
if
(
strncmp
(
compat
,
"sab82532"
,
8
)
==
0
)
{
/* Yep. */
goto
ebus_don
e
;
callback
(
edev
,
arg
);
continu
e
;
}
}
}
}
}
ebus_done:
if
(
!
edev
)
return
-
ENODEV
;
}
static
void
__init
sab_count_callback
(
struct
linux_ebus_device
*
edev
,
void
*
arg
)
{
int
*
count_p
=
arg
;
(
*
count_p
)
++
;
}
static
void
__init
sab_attach_callback
(
struct
linux_ebus_device
*
edev
,
void
*
arg
)
{
int
*
instance_p
=
arg
;
struct
uart_sunsab_port
*
up
;
unsigned
long
regs
,
offset
;
int
i
;
regs
=
edev
->
resource
[
0
].
start
;
offset
=
sizeof
(
union
sab82532_async_regs
);
for
(
i
=
0
;
i
<
2
;
i
++
)
{
if
(
memory_start
)
{
*
memory_start
=
(
*
memory_start
+
7
)
&
~
(
7
);
sab
=
(
struct
sab82532
*
)
*
memory_start
;
*
memory_start
+=
sizeof
(
struct
sab82532
);
}
else
{
sab
=
(
struct
sab82532
*
)
kmalloc
(
sizeof
(
struct
sab82532
),
GFP_KERNEL
);
if
(
!
sab
)
{
printk
(
"sab82532: can't alloc sab struct
\n
"
);
break
;
}
}
memset
(
sab
,
0
,
sizeof
(
struct
sab82532
));
sab
->
regs
=
ioremap
(
regs
+
offset
,
sizeof
(
union
sab82532_async_regs
));
sab
->
irq
=
edev
->
irqs
[
0
];
sab
->
line
=
1
-
i
;
sab
->
xmit_fifo_size
=
32
;
sab
->
recv_fifo_size
=
32
;
up
=
&
sunsab_ports
[(
*
instance_p
*
2
)
+
i
];
writeb
(
SAB82532_IPC_IC_ACT_LOW
,
&
sab
->
regs
->
w
.
ipc
);
memset
(
up
,
0
,
sizeof
(
*
up
));
up
->
regs
=
ioremap
(
regs
+
offset
,
sizeof
(
union
sab82532_async_regs
));
up
->
irq
=
edev
->
irqs
[
0
];
up
->
sab_line
=
1
-
i
;
up
->
xmit_fifo_size
=
32
;
up
->
recv_fifo_size
=
32
;
sab
->
next
=
sab82532_chain
;
sab82532_chain
=
sab
;
writeb
(
SAB82532_IPC_IC_ACT_LOW
,
&
up
->
regs
->
w
.
ipc
);
offset
-=
sizeof
(
union
sab82532_async_regs
);
}
return
0
;
}
#ifndef MODULE
static
void
__init
sab82532_kgdb_hook
(
int
line
)
static
int
__init
probe_for_sabs
(
void
)
{
prom_printf
(
"sab82532: kgdb support is not implemented, yet
\n
"
);
prom_halt
();
}
#endif
int
this_sab
=
0
;
static
inline
void
__init
show_serial_version
(
void
)
{
char
*
revision
=
"$Revision: 1.66 $"
;
char
*
version
,
*
p
;
version
=
strchr
(
revision
,
' '
);
strcpy
(
serial_version
,
++
version
);
p
=
strchr
(
serial_version
,
' '
);
*
p
=
'\0'
;
printk
(
"SAB82532 serial driver version %s
\n
"
,
serial_version
);
}
/* Find device instances. */
for_each_sab_edev
(
&
sab_count_callback
,
&
this_sab
);
if
(
!
this_sab
)
return
-
ENODEV
;
extern
int
su_num_ports
;
/* Allocate tables. */
sunsab_ports
=
kmalloc
(
sizeof
(
struct
uart_sunsab_port
)
*
this_sab
*
2
,
GFP_KERNEL
);
if
(
!
sunsab_ports
)
return
-
ENOMEM
;
/*
* The serial driver boot-time initialization code!
*/
int
__init
sab82532_init
(
void
)
{
struct
sab82532
*
info
;
int
i
;
num_channels
=
this_sab
*
2
;
if
(
!
sab82532_chain
)
get_sab82532
(
0
);
if
(
!
sab82532_chain
)
return
-
ENODEV
;
this_sab
=
0
;
for_each_sab_edev
(
&
sab_attach_callback
,
&
this_sab
);
return
0
;
}
init_bh
(
SERIAL_BH
,
do_serial_bh
);
static
void
__init
sunsab_init_hw
(
void
)
{
int
i
;
show_serial_version
();
for
(
i
=
0
;
i
<
num_channels
;
i
++
)
{
struct
uart_sunsab_port
*
up
=
&
sunsab_ports
[
i
];
/* Initialize the tty_driver structure */
memset
(
&
serial_driver
,
0
,
sizeof
(
struct
tty_driver
));
serial_driver
.
magic
=
TTY_DRIVER_MAGIC
;
serial_driver
.
driver_name
=
"serial"
;
#ifdef CONFIG_DEVFS_FS
serial_driver
.
name
=
"tts/%d"
;
#else
serial_driver
.
name
=
"ttyS"
;
#endif
serial_driver
.
major
=
TTY_MAJOR
;
serial_driver
.
minor_start
=
64
+
su_num_ports
;
serial_driver
.
num
=
NR_PORTS
;
serial_driver
.
type
=
TTY_DRIVER_TYPE_SERIAL
;
serial_driver
.
subtype
=
SERIAL_TYPE_NORMAL
;
serial_driver
.
init_termios
=
tty_std_termios
;
serial_driver
.
init_termios
.
c_cflag
=
B9600
|
CS8
|
CREAD
|
HUPCL
|
CLOCAL
;
serial_driver
.
flags
=
TTY_DRIVER_REAL_RAW
;
serial_driver
.
refcount
=
&
sab82532_refcount
;
serial_driver
.
table
=
sab82532_table
;
serial_driver
.
termios
=
sab82532_termios
;
serial_driver
.
termios_locked
=
sab82532_termios_locked
;
serial_driver
.
open
=
sab82532_open
;
serial_driver
.
close
=
sab82532_close
;
serial_driver
.
write
=
sab82532_write
;
serial_driver
.
put_char
=
sab82532_put_char
;
serial_driver
.
flush_chars
=
sab82532_flush_chars
;
serial_driver
.
write_room
=
sab82532_write_room
;
serial_driver
.
chars_in_buffer
=
sab82532_chars_in_buffer
;
serial_driver
.
flush_buffer
=
sab82532_flush_buffer
;
serial_driver
.
ioctl
=
sab82532_ioctl
;
serial_driver
.
throttle
=
sab82532_throttle
;
serial_driver
.
unthrottle
=
sab82532_unthrottle
;
serial_driver
.
send_xchar
=
sab82532_send_xchar
;
serial_driver
.
set_termios
=
sab82532_set_termios
;
serial_driver
.
stop
=
sab82532_stop
;
serial_driver
.
start
=
sab82532_start
;
serial_driver
.
hangup
=
sab82532_hangup
;
serial_driver
.
break_ctl
=
sab82532_break
;
serial_driver
.
wait_until_sent
=
sab82532_wait_until_sent
;
serial_driver
.
read_proc
=
sab82532_read_proc
;
up
->
port
.
line
=
i
;
up
->
port
.
ops
=
&
sunsab_pops
;
up
->
port
.
type
=
PORT_SUNSAB
;
up
->
port
.
uartclk
=
SAB_BASE_BAUD
;
/*
* The callout device is just like normal device except for
* major number and the subtype code.
*/
callout_driver
=
serial_driver
;
#ifdef CONFIG_DEVFS_FS
callout_driver
.
name
=
"cua/%d"
;
#else
callout_driver
.
name
=
"cua"
;
#endif
callout_driver
.
major
=
TTYAUX_MAJOR
;
callout_driver
.
subtype
=
SERIAL_TYPE_CALLOUT
;
callout_driver
.
read_proc
=
0
;
callout_driver
.
proc_entry
=
0
;
if
(
tty_register_driver
(
&
serial_driver
))
panic
(
"Couldn't register serial driver
\n
"
);
if
(
tty_register_driver
(
&
callout_driver
))
panic
(
"Couldn't register callout driver
\n
"
);
for
(
info
=
sab82532_chain
,
i
=
0
;
info
;
info
=
info
->
next
,
i
++
)
{
info
->
magic
=
SERIAL_MAGIC
;
info
->
type
=
readb
(
&
info
->
regs
->
r
.
vstr
)
&
0x0f
;
writeb
(
~
((
1
<<
1
)
|
(
1
<<
2
)
|
(
1
<<
4
)),
&
info
->
regs
->
w
.
pcr
);
writeb
(
0xff
,
&
info
->
regs
->
w
.
pim
);
if
(
info
->
line
==
0
)
{
info
->
pvr_dsr_bit
=
(
1
<<
0
);
info
->
pvr_dtr_bit
=
(
1
<<
1
);
up
->
type
=
readb
(
&
up
->
regs
->
r
.
vstr
)
&
0x0f
;
writeb
(
~
((
1
<<
1
)
|
(
1
<<
2
)
|
(
1
<<
4
)),
&
up
->
regs
->
w
.
pcr
);
writeb
(
0xff
,
&
up
->
regs
->
w
.
pim
);
if
(
up
->
sab_line
==
0
)
{
up
->
pvr_dsr_bit
=
(
1
<<
0
);
up
->
pvr_dtr_bit
=
(
1
<<
1
);
}
else
{
info
->
pvr_dsr_bit
=
(
1
<<
3
);
info
->
pvr_dtr_bit
=
(
1
<<
2
);
up
->
pvr_dsr_bit
=
(
1
<<
3
);
up
->
pvr_dtr_bit
=
(
1
<<
2
);
}
writeb
((
1
<<
1
)
|
(
1
<<
2
)
|
(
1
<<
4
),
&
info
->
regs
->
w
.
pvr
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FRTS
,
&
info
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
info
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
info
->
regs
->
rw
.
mode
);
info
->
custom_divisor
=
16
;
info
->
close_delay
=
5
*
HZ
/
10
;
info
->
closing_wait
=
30
*
HZ
;
info
->
tec_timeout
=
SAB82532_MAX_TEC_TIMEOUT
;
info
->
cec_timeout
=
SAB82532_MAX_CEC_TIMEOUT
;
info
->
x_char
=
0
;
info
->
event
=
0
;
info
->
blocked_open
=
0
;
info
->
tqueue
.
routine
=
do_softint
;
info
->
tqueue
.
data
=
info
;
info
->
tqueue_hangup
.
routine
=
do_serial_hangup
;
info
->
tqueue_hangup
.
data
=
info
;
info
->
callout_termios
=
callout_driver
.
init_termios
;
info
->
normal_termios
=
serial_driver
.
init_termios
;
init_waitqueue_head
(
&
info
->
open_wait
);
init_waitqueue_head
(
&
info
->
close_wait
);
init_waitqueue_head
(
&
info
->
delta_msr_wait
);
info
->
icount
.
cts
=
info
->
icount
.
dsr
=
info
->
icount
.
rng
=
info
->
icount
.
dcd
=
0
;
info
->
icount
.
rx
=
info
->
icount
.
tx
=
0
;
info
->
icount
.
frame
=
info
->
icount
.
parity
=
0
;
info
->
icount
.
overrun
=
info
->
icount
.
brk
=
0
;
if
(
!
(
info
->
line
&
0x01
))
{
if
(
request_irq
(
info
->
irq
,
sab82532_interrupt
,
SA_SHIRQ
,
"serial(sab82532)"
,
info
))
{
printk
(
"sab82532: can't get IRQ %x
\n
"
,
info
->
irq
);
panic
(
"sab82532 initialization failed"
);
writeb
((
1
<<
1
)
|
(
1
<<
2
)
|
(
1
<<
4
),
&
up
->
regs
->
w
.
pvr
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_FRTS
,
&
up
->
regs
->
rw
.
mode
);
writeb
(
readb
(
&
up
->
regs
->
rw
.
mode
)
|
SAB82532_MODE_RTS
,
&
up
->
regs
->
rw
.
mode
);
up
->
tec_timeout
=
SAB82532_MAX_TEC_TIMEOUT
;
up
->
cec_timeout
=
SAB82532_MAX_CEC_TIMEOUT
;
if
(
!
(
up
->
sab_line
&
0x01
))
{
if
(
request_irq
(
up
->
irq
,
sunsab_interrupt
,
SA_SHIRQ
,
"serial(sab82532)"
,
up
))
{
printk
(
"sunsab%d: can't get IRQ %x
\n
"
,
i
,
up
->
irq
);
continue
;
}
}
printk
(
KERN_INFO
"
ttyS%02
d at 0x%lx (irq = %s) is a SAB82532 %s
\n
"
,
i
nfo
->
line
+
su_num_ports
,
(
unsigned
long
)
info
->
regs
,
__irq_itoa
(
info
->
irq
),
sab82532_version
[
info
->
type
]);
"
sunsab%
d at 0x%lx (irq = %s) is a SAB82532 %s
\n
"
,
i
,
(
unsigned
long
)
up
->
regs
,
__irq_itoa
(
up
->
irq
),
sab82532_version
[
up
->
type
]);
}
#ifdef SERIAL_LOG_DEVICE
dprint_init
(
SERIAL_LOG_DEVICE
);
#endif
return
0
;
}
int
__init
sab82532_probe
(
void
)
static
int
__init
sunsab_init
(
void
)
{
int
node
,
enode
,
snode
;
char
model
[
32
];
int
len
;
int
ret
=
probe_for_sabs
();
int
i
;
node
=
prom_getchild
(
prom_root_node
);
node
=
prom_searchsiblings
(
node
,
"pci"
)
;
if
(
ret
<
0
)
return
ret
;
/*
* Check for SUNW,sabre on Ultra 5/10/AXi.
*/
len
=
prom_getproperty
(
node
,
"model"
,
model
,
sizeof
(
model
));
if
((
len
>
0
)
&&
!
strncmp
(
model
,
"SUNW,sabre"
,
len
))
{
node
=
prom_getchild
(
node
);
node
=
prom_searchsiblings
(
node
,
"pci"
);
}
sunsab_init_hw
();
/*
* For each PCI bus...
*/
while
(
node
)
{
enode
=
prom_getchild
(
node
);
enode
=
prom_searchsiblings
(
enode
,
"ebus"
);
sunsab_reg
.
minor
=
sunserial_current_minor
;
sunserial_current_minor
+=
num_channels
;
/*
* For each EBus on this PCI...
*/
while
(
enode
)
{
int
child
;
sunsab_reg
.
nr
=
num_channels
;
sunsab_reg
.
cons
=
&
sunsab_console
;
child
=
prom_getchild
(
enode
);
snode
=
prom_searchsiblings
(
child
,
"se"
);
if
(
snode
)
goto
found
;
ret
=
uart_register_driver
(
&
sunsab_reg
);
if
(
ret
<
0
)
{
int
i
;
snode
=
prom_searchsiblings
(
child
,
"serial"
);
if
(
snode
)
{
char
compat
[
32
];
int
clen
;
clen
=
prom_getproperty
(
snode
,
"compatible"
,
compat
,
sizeof
(
compat
));
if
(
clen
>
0
)
{
if
(
strncmp
(
compat
,
"sab82532"
,
8
)
==
0
)
goto
found
;
}
}
for
(
i
=
0
;
i
<
num_channels
;
i
++
)
{
struct
uart_sunsab_port
*
up
=
&
sunsab_ports
[
i
];
enode
=
prom_getsibling
(
enode
);
enode
=
prom_searchsiblings
(
enode
,
"ebus"
);
if
(
!
(
up
->
sab_line
&
0x01
))
free_irq
(
up
->
irq
,
up
);
iounmap
(
up
->
regs
);
}
node
=
prom_getsibling
(
node
);
node
=
prom_searchsiblings
(
node
,
"pci"
);
}
return
-
ENODEV
;
found:
#ifdef CONFIG_SERIAL_CONSOLE
sunserial_setinitfunc
(
sab82532_console_init
);
#endif
#ifndef MODULE
sunserial_setinitfunc
(
sab82532_init
);
rs_ops
.
rs_kgdb_hook
=
sab82532_kgdb_hook
;
#endif
return
0
;
}
#ifdef MODULE
MODULE_LICENSE
(
"GPL"
);
int
init_module
(
void
)
{
if
(
get_sab82532
(
0
))
return
-
ENODEV
;
return
sab82532_init
();
}
void
cleanup_module
(
void
)
{
struct
sab82532
*
sab
;
unsigned
long
flags
;
int
e1
,
e2
;
/* printk("Unloading %s: version %s\n", serial_name, serial_version); */
save_flags
(
flags
);
cli
();
remove_bh
(
SERIAL_BH
);
if
((
e1
=
tty_unregister_driver
(
&
serial_driver
)))
printk
(
"SERIAL: failed to unregister serial driver (%d)
\n
"
,
e1
);
if
((
e2
=
tty_unregister_driver
(
&
callout_driver
)))
printk
(
"SERIAL: failed to unregister callout driver (%d)
\n
"
,
e2
);
restore_flags
(
flags
);
if
(
tmp_buf
)
{
free_page
((
unsigned
long
)
tmp_buf
);
tmp_buf
=
NULL
;
}
for
(
sab
=
sab82532_chain
;
sab
;
sab
=
sab
->
next
)
{
if
(
!
(
sab
->
line
&
0x01
))
free_irq
(
sab
->
irq
,
sab
);
iounmap
(
sab
->
regs
);
}
}
#endif
/* MODULE */
#ifdef CONFIG_SERIAL_CONSOLE
static
__inline__
void
sab82532_console_putchar
(
struct
sab82532
*
info
,
char
c
)
{
unsigned
long
flags
;
save_flags
(
flags
);
cli
();
sab82532_tec_wait
(
info
);
writeb
(
c
,
&
info
->
regs
->
w
.
tic
);
restore_flags
(
flags
);
}
kfree
(
sunsab_ports
);
sunsab_ports
=
NULL
;
static
void
sab82532_console_write
(
struct
console
*
con
,
const
char
*
s
,
unsigned
n
)
{
struct
sab82532
*
info
;
int
i
;
info
=
sab82532_chain
;
for
(
i
=
con
->
index
;
i
;
i
--
)
{
info
=
info
->
next
;
if
(
!
info
)
return
;
}
for
(
i
=
0
;
i
<
n
;
i
++
)
{
if
(
*
s
==
'\n'
)
sab82532_console_putchar
(
info
,
'\r'
);
sab82532_console_putchar
(
info
,
*
s
++
);
}
sab82532_tec_wait
(
info
);
}
static
kdev_t
sab82532_console_device
(
struct
console
*
con
)
{
return
mk_kdev
(
TTY_MAJOR
,
64
+
con
->
index
);
}
static
int
sab82532_console_setup
(
struct
console
*
con
,
char
*
options
)
{
static
struct
tty_struct
c_tty
;
static
struct
termios
c_termios
;
struct
sab82532
*
info
;
tcflag_t
cflag
;
int
i
;
info
=
sab82532_chain
;
for
(
i
=
con
->
index
;
i
;
i
--
)
{
info
=
info
->
next
;
if
(
!
info
)
return
-
ENODEV
;
return
ret
;
}
info
->
is_console
=
1
;
/*
* Initialize the hardware
*/
sab82532_init_line
(
info
);
/*
* Finally, enable interrupts
*/
info
->
interrupt_mask0
=
SAB82532_IMR0_PERR
|
SAB82532_IMR0_FERR
|
SAB82532_IMR0_PLLA
|
SAB82532_IMR0_CDSC
;
writeb
(
info
->
interrupt_mask0
,
&
info
->
regs
->
w
.
imr0
);
info
->
interrupt_mask1
=
SAB82532_IMR1_BRKT
|
SAB82532_IMR1_ALLS
|
SAB82532_IMR1_XOFF
|
SAB82532_IMR1_TIN
|
SAB82532_IMR1_CSC
|
SAB82532_IMR1_XON
|
SAB82532_IMR1_XPR
;
writeb
(
info
->
interrupt_mask1
,
&
info
->
regs
->
w
.
imr1
);
printk
(
"Console: ttyS%d (SAB82532)
\n
"
,
info
->
line
);
sunserial_console_termios
(
con
);
cflag
=
con
->
cflag
;
for
(
i
=
0
;
i
<
num_channels
;
i
++
)
{
struct
uart_sunsab_port
*
up
=
&
sunsab_ports
[
i
]
;
/*
* Fake up the tty and tty->termios structures so we can use
* change_speed (and eliminate a lot of duplicate code).
*/
if
(
!
info
->
tty
)
{
memset
(
&
c_tty
,
0
,
sizeof
(
c_tty
));
info
->
tty
=
&
c_tty
;
}
if
(
!
info
->
tty
->
termios
)
{
memset
(
&
c_termios
,
0
,
sizeof
(
c_termios
));
info
->
tty
->
termios
=
&
c_termios
;
uart_add_one_port
(
&
sunsab_reg
,
&
up
->
port
);
}
info
->
tty
->
termios
->
c_cflag
=
con
->
cflag
;
change_speed
(
info
);
sunsab_console_init
(
);
/* Now take out the pointers to static structures if necessary */
if
(
info
->
tty
->
termios
==
&
c_termios
)
info
->
tty
->
termios
=
0
;
if
(
info
->
tty
==
&
c_tty
)
info
->
tty
=
0
;
return
0
;
}
static
struct
console
sab82532_console
=
{
.
name
=
"ttyS"
,
.
write
=
sab82532_console_write
,
.
device
=
sab82532_console_device
,
.
setup
=
sab82532_console_setup
,
.
flags
=
CON_PRINTBUFFER
,
.
index
=
-
1
,
};
int
__init
sab82532_console_init
(
void
)
static
void
__exit
sunsab_exit
(
void
)
{
extern
int
su_console_registered
;
if
(
con_is_present
()
||
su_console_registered
)
return
0
;
int
i
;
if
(
!
sab82532_chain
)
{
prom_printf
(
"sab82532_console_setup: can't get SAB82532 chain"
);
prom_halt
();
}
for
(
i
=
0
;
i
<
num_channels
;
i
++
)
{
struct
uart_sunsab_port
*
up
=
&
sunsab_ports
[
i
];
sab82532_console
.
index
=
serial_console
-
1
;
register_console
(
&
sab82532_console
);
return
0
;
}
uart_remove_one_port
(
&
sunsab_reg
,
&
up
->
port
);
#ifdef SERIAL_LOG_DEVICE
if
(
!
(
up
->
sab_line
&
0x01
))
free_irq
(
up
->
irq
,
up
);
iounmap
(
up
->
regs
);
}
static
int
serial_log_device
=
0
;
uart_unregister_driver
(
&
sunsab_reg
)
;
static
void
dprint_init
(
int
tty
)
{
serial_console
=
tty
+
1
;
sab82532_console
.
index
=
tty
;
sab82532_console_setup
(
&
sab82532_console
,
""
);
serial_console
=
0
;
serial_log_device
=
tty
+
1
;
kfree
(
sunsab_ports
);
sunsab_ports
=
NULL
;
}
int
dprintf
(
const
char
*
fmt
,
...)
{
static
char
buffer
[
4096
];
va_list
args
;
int
i
;
module_init
(
sunsab_init
);
module_exit
(
sunsab_exit
);
if
(
!
serial_log_device
)
return
0
;
va_start
(
args
,
fmt
);
i
=
vsprintf
(
buffer
,
fmt
,
args
);
va_end
(
args
);
sab82532_console
.
write
(
&
sab82532_console
,
buffer
,
i
);
return
i
;
}
#endif
/* SERIAL_LOG_DEVICE */
#endif
/* CONFIG_SERIAL_CONSOLE */
MODULE_AUTHOR
(
"Eddie C. Dost and David S. Miller"
);
MODULE_DESCRIPTION
(
"Sun SAB82532 serial port driver"
);
MODULE_LICENSE
(
"GPL"
);
include/asm-sparc64/sab82532
.h
→
drivers/serial/sunsab
.h
View file @
130ca59d
/* $Id: sab82532.h,v 1.7 2001/05/23 23:09:10 ecd Exp $
* sab82532.h: Register Definitions for the Siemens SAB82532 DUSCC
/* sunsab.h: Register Definitions for the Siemens SAB82532 DUSCC
*
* Copyright (C) 1997 Eddie C. Dost (ecd@skynet.be)
*/
#ifndef _SPARC64_SAB82532_H
#define _SPARC64_SAB82532_H
#include <linux/types.h>
#include <linux/serial.h>
#include <linux/circ_buf.h>
#ifndef _SUNSAB_H
#define _SUNSAB_H
struct
sab82532_async_rd_regs
{
u8
rfifo
[
0x20
];
/* Receive FIFO */
...
...
@@ -120,8 +115,6 @@ union sab82532_async_regs {
__volatile__
struct
sab82532_async_rw_regs
rw
;
};
#define NR_PORTS 2
union
sab82532_irq_status
{
unsigned
short
stat
;
struct
{
...
...
@@ -130,62 +123,10 @@ union sab82532_irq_status {
}
sreg
;
};
struct
sab82532
{
int
magic
;
int
baud_base
;
union
sab82532_async_regs
*
regs
;
int
irq
;
int
flags
;
/* defined in tty.h */
int
type
;
/* SAB82532 version */
struct
tty_struct
*
tty
;
int
read_status_mask
;
int
ignore_status_mask
;
int
timeout
;
int
xmit_fifo_size
;
int
recv_fifo_size
;
int
custom_divisor
;
int
baud
;
unsigned
int
cec_timeout
;
unsigned
int
tec_timeout
;
int
x_char
;
int
close_delay
;
unsigned
short
closing_wait
;
unsigned
short
closing_wait2
;
unsigned
long
irqflags
;
int
is_console
;
unsigned
char
interrupt_mask0
;
unsigned
char
interrupt_mask1
;
unsigned
char
pvr_dtr_bit
;
unsigned
char
pvr_dsr_bit
;
unsigned
char
dcd
;
unsigned
char
cts
;
unsigned
char
dsr
;
unsigned
long
event
;
unsigned
long
last_active
;
int
line
;
int
count
;
int
blocked_open
;
long
session
;
long
pgrp
;
struct
circ_buf
xmit
;
struct
tq_struct
tqueue
;
struct
tq_struct
tqueue_hangup
;
struct
async_icount
icount
;
struct
termios
normal_termios
;
struct
termios
callout_termios
;
wait_queue_head_t
open_wait
;
wait_queue_head_t
close_wait
;
wait_queue_head_t
delta_msr_wait
;
struct
sab82532
*
next
;
struct
sab82532
*
prev
;
};
/* irqflags bits */
#define SAB82532_ALLS 0x00000001
#define SAB82532_XPR 0x00000002
/* RFIFO Status Byte */
#define SAB82532_RSTAT_PE 0x80
#define SAB82532_RSTAT_FE 0x40
...
...
@@ -377,4 +318,4 @@ struct sab82532 {
#define SAB82532_CCR4_ICD 0x10
#endif
/* !(_S
PARC64_SAB82532
_H) */
#endif
/* !(_S
UNSAB
_H) */
drivers/serial/sunsu.c
View file @
130ca59d
...
...
@@ -1362,7 +1362,7 @@ static void sunsu_console_write(struct console *co, const char *s,
static
kdev_t
sunsu_console_device
(
struct
console
*
co
)
{
return
mk_kdev
(
TTY_MAJOR
,
64
+
co
->
index
);
return
mk_kdev
(
sunsu_reg
.
major
,
sunsu_reg
.
minor
+
co
->
index
);
}
/*
...
...
@@ -1379,6 +1379,9 @@ static int __init sunsu_console_setup(struct console *co, char *options)
int
parity
=
'n'
;
int
flow
=
'n'
;
printk
(
"Console: ttyS%d (SU)
\n
"
,
(
sunsu_reg
.
minor
-
64
)
+
co
->
index
);
/*
* Check whether an invalid uart number has been specified, and
* if so, search for the first available port that does have
...
...
@@ -1414,15 +1417,23 @@ static struct console sunsu_cons = {
static
int
__init
sunsu_serial_console_init
(
void
)
{
int
i
ndex
;
int
i
;
if
(
con_is_present
())
return
0
;
index
=
serial_console
-
1
;
if
(
sunsu_ports
[
index
].
port_node
==
0
)
for
(
i
=
0
;
i
<
UART_NR
;
i
++
)
{
int
this_minor
=
sunsu_reg
.
minor
+
i
;
if
((
this_minor
-
64
)
==
(
serial_console
-
1
))
break
;
}
if
(
i
==
UART_NR
)
return
0
;
sunsu_cons
.
index
=
index
;
if
(
sunsu_ports
[
i
].
port_node
==
0
)
return
0
;
sunsu_cons
.
index
=
i
;
register_console
(
&
sunsu_cons
);
return
0
;
}
...
...
drivers/serial/sunzilog.c
View file @
130ca59d
...
...
@@ -1013,7 +1013,6 @@ static struct uart_driver sunzilog_reg = {
.
dev_name
=
"ttyS"
,
#endif
.
major
=
TTY_MAJOR
,
.
minor
=
64
,
};
static
void
*
__init
alloc_one_table
(
unsigned
long
size
)
...
...
@@ -1386,7 +1385,7 @@ sunzilog_console_write(struct console *con, const char *s, unsigned int count)
static
kdev_t
sunzilog_console_device
(
struct
console
*
con
)
{
return
mk_kdev
(
TTY_MAJOR
,
64
+
con
->
index
);
return
mk_kdev
(
sunzilog_reg
.
major
,
sunzilog_reg
.
minor
+
con
->
index
);
}
static
int
__init
sunzilog_console_setup
(
struct
console
*
con
,
char
*
options
)
...
...
@@ -1395,7 +1394,8 @@ static int __init sunzilog_console_setup(struct console *con, char *options)
unsigned
long
flags
;
int
baud
,
brg
;
printk
(
"Console: ttyS%d (Zilog8530)
\n
"
,
con
->
index
/
2
);
printk
(
"Console: ttyS%d (Zilog8530)
\n
"
,
(
sunzilog_reg
.
minor
-
64
)
+
con
->
index
);
/* Get firmware console settings. */
sunserial_console_termios
(
con
);
...
...
@@ -1447,10 +1447,21 @@ static struct console sunzilog_console = {
static
int
__init
sunzilog_console_init
(
void
)
{
int
i
;
if
(
con_is_present
())
return
0
;
sunzilog_console
.
index
=
serial_console
-
1
;
for
(
i
=
0
;
i
<
NUM_CHANNELS
;
i
++
)
{
int
this_minor
=
sunzilog_reg
.
minor
+
i
;
if
((
this_minor
-
64
)
==
(
serial_console
-
1
))
break
;
}
if
(
i
==
NUM_CHANNELS
)
return
0
;
sunzilog_console
.
index
=
i
;
register_console
(
&
sunzilog_console
);
return
0
;
}
...
...
@@ -1480,6 +1491,7 @@ static void __init sunzilog_prepare(void)
up
[(
chip
*
2
)
+
0
].
port
.
uartclk
=
ZS_CLOCK
;
up
[(
chip
*
2
)
+
0
].
port
.
fifosize
=
1
;
up
[(
chip
*
2
)
+
0
].
port
.
ops
=
&
sunzilog_pops
;
up
[(
chip
*
2
)
+
0
].
port
.
type
=
PORT_SUNZILOG
;
up
[(
chip
*
2
)
+
0
].
port
.
flags
=
0
;
up
[(
chip
*
2
)
+
0
].
port
.
line
=
(
chip
*
2
)
+
0
;
up
[(
chip
*
2
)
+
0
].
flags
|=
SUNZILOG_FLAG_IS_CHANNEL_A
;
...
...
@@ -1490,6 +1502,7 @@ static void __init sunzilog_prepare(void)
up
[(
chip
*
2
)
+
1
].
port
.
uartclk
=
ZS_CLOCK
;
up
[(
chip
*
2
)
+
1
].
port
.
fifosize
=
1
;
up
[(
chip
*
2
)
+
1
].
port
.
ops
=
&
sunzilog_pops
;
up
[(
chip
*
2
)
+
1
].
port
.
type
=
PORT_SUNZILOG
;
up
[(
chip
*
2
)
+
1
].
port
.
flags
=
0
;
up
[(
chip
*
2
)
+
1
].
port
.
line
=
(
chip
*
2
)
+
1
;
up
[(
chip
*
2
)
+
1
].
flags
|=
0
;
...
...
@@ -1607,12 +1620,10 @@ static int __init sunzilog_ports_init(void)
* in the system.
*/
sunzilog_reg
.
nr
=
NUM_CHANNELS
;
#ifdef CONFIG_SERIAL_CONSOLE
sunzilog_reg
.
cons
=
&
sunzilog_console
;
#else
sunzilog_reg
.
cons
=
NULL
;
#endif
sunzilog_reg
.
minor
=
sunserial_current_minor
;
sunserial_current_minor
+=
NUM_CHANNELS
;
ret
=
uart_register_driver
(
&
sunzilog_reg
);
if
(
ret
==
0
)
{
...
...
include/asm-sparc64/ns87303.h
View file @
130ca59d
...
...
@@ -78,9 +78,13 @@
#ifdef __KERNEL__
#include <linux/spinlock.h>
#include <asm/system.h>
#include <asm/io.h>
extern
spinlock_t
ns87303_lock
;
static
__inline__
int
ns87303_modify
(
unsigned
long
port
,
unsigned
int
index
,
unsigned
char
clr
,
unsigned
char
set
)
{
...
...
@@ -96,14 +100,16 @@ static __inline__ int ns87303_modify(unsigned long port, unsigned int index,
if
(
index
>
0x0d
)
return
-
EINVAL
;
save_flags
(
flags
);
cli
();
spin_lock_irqsave
(
&
ns87303_lock
,
flags
);
outb
(
index
,
port
);
value
=
inb
(
port
+
1
);
value
&=
~
(
reserved
[
index
]
|
clr
);
value
|=
set
;
outb
(
value
,
port
+
1
);
outb
(
value
,
port
+
1
);
restore_flags
(
flags
);
spin_unlock_irqrestore
(
&
ns87303_lock
,
flags
);
return
0
;
}
...
...
include/linux/serial_core.h
View file @
130ca59d
...
...
@@ -51,6 +51,10 @@
#define PORT_UART00 35
#define PORT_21285 37
/* Sparc type numbers. */
#define PORT_SUNZILOG 38
#define PORT_SUNSAB 39
#ifdef __KERNEL__
#include <linux/config.h>
...
...
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment