forked from Imagelibrary/rtems
73 lines
1.4 KiB
C
73 lines
1.4 KiB
C
/*
|
|
* This file contains a typical set of register access routines which may be
|
|
* used with the z85c30 chip if accesses to the chip are as follows:
|
|
*
|
|
* + registers are accessed as bytes
|
|
*
|
|
* COPYRIGHT (c) 1989-1997.
|
|
* On-Line Applications Research Corporation (OAR).
|
|
*
|
|
* The license and distribution terms for this file may be
|
|
* found in the file LICENSE in this distribution or at
|
|
* http://www.rtems.org/license/LICENSE.
|
|
*/
|
|
|
|
#include <rtems.h>
|
|
|
|
#include <libchip/z85c30.h>
|
|
|
|
#ifndef _Z85C30_MULTIPLIER
|
|
#define _Z85C30_MULTIPLIER 1
|
|
#define _Z85C30_NAME(_X) _X
|
|
#define _Z85C30_TYPE uint8_t
|
|
#endif
|
|
|
|
/*
|
|
* Z85C30 Get Register Routine
|
|
*/
|
|
|
|
uint8_t _Z85C30_NAME(z85c30_get_register)(
|
|
uintptr_t ulCtrlPort,
|
|
uint8_t ucRegNum
|
|
)
|
|
{
|
|
_Z85C30_TYPE *port;
|
|
uint8_t data;
|
|
rtems_interrupt_level level;
|
|
|
|
port = (_Z85C30_TYPE *)ulCtrlPort;
|
|
|
|
rtems_interrupt_disable(level);
|
|
|
|
if(ucRegNum) {
|
|
*port = ucRegNum;
|
|
}
|
|
data = *port;
|
|
rtems_interrupt_enable(level);
|
|
|
|
return data;
|
|
}
|
|
|
|
/*
|
|
* Z85C30 Set Register Routine
|
|
*/
|
|
|
|
void _Z85C30_NAME(z85c30_set_register)(
|
|
uintptr_t ulCtrlPort,
|
|
uint8_t ucRegNum,
|
|
uint8_t ucData
|
|
)
|
|
{
|
|
_Z85C30_TYPE *port;
|
|
rtems_interrupt_level level;
|
|
|
|
port = (_Z85C30_TYPE *)ulCtrlPort;
|
|
|
|
rtems_interrupt_disable(level);
|
|
if(ucRegNum) {
|
|
*port = ucRegNum;
|
|
}
|
|
*port = ucData;
|
|
rtems_interrupt_enable(level);
|
|
}
|