1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
/* SPDX-License-Identifier: BSD-2-Clause */
/**
* @file
*
* @brief Driver for RTD316 ISA SCC Board
*
* The RTD316 has a single Z85C30.
*/
/*
* COPYRIGHT (c) 1989-2014.
* On-Line Applications Research Corporation (OAR).
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/
#include <bsp.h>
#include <termios.h>
#include <stdio.h>
#include <stdlib.h>
#include <rtems/termiostypes.h>
#include <libchip/serial.h>
#include <libchip/z85c30.h>
#include <rtems/bspIo.h>
#include <bsp/rtd316.h>
#include <rtems/score/i386.h>
#include "../../shared/dev/serial/legacy-console.h"
#define RTD_CLOCK_RATE (460800 * 32)
uint8_t rtd316_com_get_register(uint32_t addr, uint8_t reg)
{
register uint8_t val = 0;
outport_byte( addr, reg );
/* It appears the no delay is needed between the accesses. */
inport_byte( addr, val );
return val;
}
void rtd316_com_set_register(uint32_t addr,uint8_t reg, uint8_t val)
{
outport_byte( addr, reg );
/* It appears the no delay is needed between the accesses. */
outport_byte( addr, val );
}
rtems_device_driver rtd316_initialize(
rtems_device_major_number major,
rtems_device_minor_number minor_arg,
void *arg
)
{
int p;
console_tbl *ports;
console_tbl *port_p;
/*
* Now allocate array of device structures and fill them in
*/
ports = calloc( 2, sizeof( console_tbl ) );
port_p = ports;
for ( p=0 ; p<2 ; p++ ) {
char name[32];
sprintf( name, "/dev/rtd316_1_%d", p );
printk("Found %s\n", name );
port_p->sDeviceName = strdup( name );
port_p->deviceType = SERIAL_Z85C30;
#if 0
port_p->pDeviceFns = &z85c30_fns_polled;
#else
port_p->pDeviceFns = &z85c30_fns;
#endif
port_p->deviceProbe = NULL;
port_p->pDeviceFlow = NULL;
port_p->ulMargin = 16;
port_p->ulHysteresis = 8;
port_p->pDeviceParams = (void *) 9600;
port_p->getRegister = rtd316_com_get_register;
port_p->setRegister = rtd316_com_set_register;
port_p->getData = NULL;
port_p->setData = NULL;
port_p->ulClock = RTD_CLOCK_RATE;
port_p->ulIntVector = 9;
if ( p==0 ) {
port_p->ulDataPort = 0;
port_p->ulCtrlPort1 = 0x340;
port_p->ulCtrlPort2 = 0x341;
} else {
port_p->ulDataPort = 1;
port_p->ulCtrlPort1 = 0x342;
port_p->ulCtrlPort2 = 0x343;
}
port_p++;
} /* end ports */
/*
* Register the devices
*/
console_register_devices( ports, 2 );
return RTEMS_SUCCESSFUL;
}
|