Rewrote the xxx_load routines for the drivers in assembler to save some
space. git-svn-id: svn://svn.cc65.org/cc65/trunk@3756 b7a2c559-68d2-44c3-8de9-860c34a00d81
This commit is contained in:
@@ -1 +0,0 @@
|
|||||||
joy_load.s
|
|
||||||
|
|||||||
@@ -29,11 +29,12 @@ CFLAGS = -Osir -g -T -t $(SYS) --forget-inc-paths -I . -I ../../include
|
|||||||
#--------------------------------------------------------------------------
|
#--------------------------------------------------------------------------
|
||||||
# Object files
|
# Object files
|
||||||
|
|
||||||
C_OBJS = joy_load.o
|
C_OBJS =
|
||||||
|
|
||||||
S_OBJS = joy-kernel.o \
|
S_OBJS = joy-kernel.o \
|
||||||
joy_read.o \
|
joy_read.o \
|
||||||
joy_count.o \
|
joy_count.o \
|
||||||
|
joy_load.o \
|
||||||
joy_unload.o
|
joy_unload.o
|
||||||
|
|
||||||
#--------------------------------------------------------------------------
|
#--------------------------------------------------------------------------
|
||||||
|
|||||||
@@ -1,99 +0,0 @@
|
|||||||
/*****************************************************************************/
|
|
||||||
/* */
|
|
||||||
/* joy_load.c */
|
|
||||||
/* */
|
|
||||||
/* Loader module for joystick drivers */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* (C) 2002-2006, Ullrich von Bassewitz */
|
|
||||||
/* R<>merstrasse 52 */
|
|
||||||
/* D-70794 Filderstadt */
|
|
||||||
/* EMail: uz@cc65.org */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* This software is provided 'as-is', without any expressed or implied */
|
|
||||||
/* warranty. In no event will the authors be held liable for any damages */
|
|
||||||
/* arising from the use of this software. */
|
|
||||||
/* */
|
|
||||||
/* Permission is granted to anyone to use this software for any purpose, */
|
|
||||||
/* including commercial applications, and to alter it and redistribute it */
|
|
||||||
/* freely, subject to the following restrictions: */
|
|
||||||
/* */
|
|
||||||
/* 1. The origin of this software must not be misrepresented; you must not */
|
|
||||||
/* claim that you wrote the original software. If you use this software */
|
|
||||||
/* in a product, an acknowledgment in the product documentation would be */
|
|
||||||
/* appreciated but is not required. */
|
|
||||||
/* 2. Altered source versions must be plainly marked as such, and must not */
|
|
||||||
/* be misrepresented as being the original software. */
|
|
||||||
/* 3. This notice may not be removed or altered from any source */
|
|
||||||
/* distribution. */
|
|
||||||
/* */
|
|
||||||
/*****************************************************************************/
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
#include <unistd.h>
|
|
||||||
#include <fcntl.h>
|
|
||||||
#include <modload.h>
|
|
||||||
#include <joystick.h>
|
|
||||||
#include <joystick/joy-kernel.h>
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Use static local variables, since the module is not reentrant anyway */
|
|
||||||
#pragma staticlocals (on);
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
unsigned char __fastcall__ joy_load_driver (const char* name)
|
|
||||||
/* Load a joystick driver and return an error code */
|
|
||||||
{
|
|
||||||
static struct mod_ctrl ctrl = {
|
|
||||||
read /* Read from disk */
|
|
||||||
};
|
|
||||||
unsigned char Res;
|
|
||||||
|
|
||||||
/* Check if we do already have a driver loaded. If so, remove it. */
|
|
||||||
if (joy_drv != 0) {
|
|
||||||
joy_uninstall ();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Now open the file */
|
|
||||||
ctrl.callerdata = open (name, O_RDONLY);
|
|
||||||
if (ctrl.callerdata >= 0) {
|
|
||||||
|
|
||||||
/* Load the module */
|
|
||||||
Res = mod_load (&ctrl);
|
|
||||||
|
|
||||||
/* Close the input file */
|
|
||||||
close (ctrl.callerdata);
|
|
||||||
|
|
||||||
/* Check the return code */
|
|
||||||
if (Res == MLOAD_OK) {
|
|
||||||
|
|
||||||
/* Check the driver signature, install the driver */
|
|
||||||
Res = joy_install (ctrl.module);
|
|
||||||
|
|
||||||
/* If the driver did not install correctly, remove it from
|
|
||||||
* memory again.
|
|
||||||
*/
|
|
||||||
if (Res != JOY_ERR_OK) {
|
|
||||||
/* Do not call mouse_uninstall here, since the driver is not
|
|
||||||
* correctly installed.
|
|
||||||
*/
|
|
||||||
mod_free (joy_drv);
|
|
||||||
joy_clear_ptr ();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Return the error code */
|
|
||||||
return Res;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Error loading the driver */
|
|
||||||
return JOY_ERR_CANNOT_LOAD;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
121
libsrc/joystick/joy_load.s
Normal file
121
libsrc/joystick/joy_load.s
Normal file
@@ -0,0 +1,121 @@
|
|||||||
|
;
|
||||||
|
; Ullrich von Bassewitz, 2006-06-05
|
||||||
|
;
|
||||||
|
; unsigned char __fastcall__ joy_load_driver (const char* driver);
|
||||||
|
; /* Load and install a joystick driver. Return an error code. */
|
||||||
|
|
||||||
|
|
||||||
|
.include "joy-kernel.inc"
|
||||||
|
.include "joy-error.inc"
|
||||||
|
.include "modload.inc"
|
||||||
|
.include "fcntl.inc"
|
||||||
|
|
||||||
|
.import pushax
|
||||||
|
.import pusha0
|
||||||
|
.import incsp2
|
||||||
|
.import _open
|
||||||
|
.import _read
|
||||||
|
.import _close
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
;----------------------------------------------------------------------------
|
||||||
|
; Variables
|
||||||
|
|
||||||
|
.data
|
||||||
|
|
||||||
|
ctrl: .addr _read
|
||||||
|
.res 2 ; CALLERDATA
|
||||||
|
.res 2 ; MODULE
|
||||||
|
.res 2 ; MODULE_SIZE
|
||||||
|
.res 2 ; MODULE_ID
|
||||||
|
|
||||||
|
;----------------------------------------------------------------------------
|
||||||
|
; Code
|
||||||
|
|
||||||
|
.code
|
||||||
|
|
||||||
|
.proc _joy_load_driver
|
||||||
|
|
||||||
|
; Save name on the C stack. We will need it later as parameter passed to open()
|
||||||
|
|
||||||
|
jsr pushax
|
||||||
|
|
||||||
|
; Check if we do already have a driver loaded. If so, remove it.
|
||||||
|
|
||||||
|
lda _joy_drv
|
||||||
|
ora _joy_drv+1
|
||||||
|
beq @L1
|
||||||
|
jsr _joy_uninstall
|
||||||
|
|
||||||
|
; Open the file. The name parameter is already on stack and will get removed
|
||||||
|
; by open().
|
||||||
|
; ctrl.callerdata = open (name, O_RDONLY);
|
||||||
|
|
||||||
|
@L1: lda #<O_RDONLY
|
||||||
|
jsr pusha0
|
||||||
|
ldy #4 ; Argument size
|
||||||
|
jsr _open
|
||||||
|
sta ctrl + MOD_CTRL::CALLERDATA
|
||||||
|
stx ctrl + MOD_CTRL::CALLERDATA+1
|
||||||
|
|
||||||
|
; if (ctrl.callerdata >= 0) {
|
||||||
|
|
||||||
|
txa
|
||||||
|
bmi @L3
|
||||||
|
|
||||||
|
; /* Load the module */
|
||||||
|
; Res = mod_load (&ctrl);
|
||||||
|
|
||||||
|
lda #<ctrl
|
||||||
|
ldx #>ctrl
|
||||||
|
jsr _mod_load
|
||||||
|
pha
|
||||||
|
|
||||||
|
; /* Close the input file */
|
||||||
|
; close (ctrl.callerdata);
|
||||||
|
|
||||||
|
lda ctrl + MOD_CTRL::CALLERDATA
|
||||||
|
ldx ctrl + MOD_CTRL::CALLERDATA+1
|
||||||
|
jsr _close
|
||||||
|
|
||||||
|
; /* Check the return code */
|
||||||
|
; if (Res == MLOAD_OK) {
|
||||||
|
|
||||||
|
pla
|
||||||
|
bne @L3
|
||||||
|
|
||||||
|
; Check the driver signature, install the driver. c is already on stack and
|
||||||
|
; will get removed by joy_install().
|
||||||
|
; Res = joy_install (ctrl.module);
|
||||||
|
|
||||||
|
lda ctrl + MOD_CTRL::MODULE
|
||||||
|
ldx ctrl + MOD_CTRL::MODULE+1
|
||||||
|
jsr _joy_install
|
||||||
|
|
||||||
|
; If joy_install was successful, we're done
|
||||||
|
|
||||||
|
tax
|
||||||
|
beq @L2
|
||||||
|
|
||||||
|
; The driver didn't install correctly. Remove it from memory and return the
|
||||||
|
; error code.
|
||||||
|
|
||||||
|
pha ; Save the error code
|
||||||
|
lda _joy_drv
|
||||||
|
ldx _joy_drv+1
|
||||||
|
jsr _mod_free ; Free the driver memory
|
||||||
|
jsr _joy_clear_ptr ; Clear joy_drv
|
||||||
|
pla ; Restore the error code
|
||||||
|
ldx #0 ; We must return an int
|
||||||
|
@L2: rts ; Done
|
||||||
|
|
||||||
|
; Open or mod_load failed. Return an error code.
|
||||||
|
|
||||||
|
@L3: lda #<JOY_ERR_CANNOT_LOAD
|
||||||
|
ldx #>JOY_ERR_CANNOT_LOAD
|
||||||
|
rts
|
||||||
|
|
||||||
|
.endproc
|
||||||
|
|
||||||
|
|
||||||
@@ -1 +0,0 @@
|
|||||||
mouse_load.s
|
|
||||||
|
|||||||
@@ -29,7 +29,7 @@ CFLAGS = -Osir -g -T -t $(SYS) --forget-inc-paths -I . -I ../../include
|
|||||||
#--------------------------------------------------------------------------
|
#--------------------------------------------------------------------------
|
||||||
# Object files
|
# Object files
|
||||||
|
|
||||||
C_OBJS = mouse_load.o
|
C_OBJS =
|
||||||
|
|
||||||
S_OBJS = mouse-kernel.o \
|
S_OBJS = mouse-kernel.o \
|
||||||
mouse_box.o \
|
mouse_box.o \
|
||||||
@@ -38,6 +38,7 @@ S_OBJS = mouse-kernel.o \
|
|||||||
mouse_hide.o \
|
mouse_hide.o \
|
||||||
mouse_info.o \
|
mouse_info.o \
|
||||||
mouse_ioctl.o \
|
mouse_ioctl.o \
|
||||||
|
mouse_load.o \
|
||||||
mouse_move.o \
|
mouse_move.o \
|
||||||
mouse_pos.o \
|
mouse_pos.o \
|
||||||
mouse_show.o \
|
mouse_show.o \
|
||||||
|
|||||||
@@ -1,101 +0,0 @@
|
|||||||
/*****************************************************************************/
|
|
||||||
/* */
|
|
||||||
/* mouse_load.c */
|
|
||||||
/* */
|
|
||||||
/* Loader for mouse drivers modules */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* (C) 2002-2003 Ullrich von Bassewitz */
|
|
||||||
/* R<>merstrasse 52 */
|
|
||||||
/* D-70794 Filderstadt */
|
|
||||||
/* EMail: uz@cc65.org */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* This software is provided 'as-is', without any expressed or implied */
|
|
||||||
/* warranty. In no event will the authors be held liable for any damages */
|
|
||||||
/* arising from the use of this software. */
|
|
||||||
/* */
|
|
||||||
/* Permission is granted to anyone to use this software for any purpose, */
|
|
||||||
/* including commercial applications, and to alter it and redistribute it */
|
|
||||||
/* freely, subject to the following restrictions: */
|
|
||||||
/* */
|
|
||||||
/* 1. The origin of this software must not be misrepresented; you must not */
|
|
||||||
/* claim that you wrote the original software. If you use this software */
|
|
||||||
/* in a product, an acknowledgment in the product documentation would be */
|
|
||||||
/* appreciated but is not required. */
|
|
||||||
/* 2. Altered source versions must be plainly marked as such, and must not */
|
|
||||||
/* be misrepresented as being the original software. */
|
|
||||||
/* 3. This notice may not be removed or altered from any source */
|
|
||||||
/* distribution. */
|
|
||||||
/* */
|
|
||||||
/*****************************************************************************/
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
#include <string.h>
|
|
||||||
#include <unistd.h>
|
|
||||||
#include <fcntl.h>
|
|
||||||
#include <modload.h>
|
|
||||||
#include <mouse.h>
|
|
||||||
#include <mouse/mouse-kernel.h>
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Use static local variables, since the module is not reentrant anyway */
|
|
||||||
#pragma staticlocals (on);
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
unsigned char __fastcall__ mouse_load_driver (const struct mouse_callbacks* c,
|
|
||||||
const char* name)
|
|
||||||
/* Load a mouse driver and return an error code */
|
|
||||||
{
|
|
||||||
static struct mod_ctrl ctrl = {
|
|
||||||
read /* Read from disk */
|
|
||||||
};
|
|
||||||
unsigned char Res;
|
|
||||||
|
|
||||||
/* Check if we do already have a driver loaded. If so, remove it. */
|
|
||||||
if (mouse_drv != 0) {
|
|
||||||
mouse_uninstall ();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Now open the file */
|
|
||||||
ctrl.callerdata = open (name, O_RDONLY);
|
|
||||||
if (ctrl.callerdata >= 0) {
|
|
||||||
|
|
||||||
/* Load the module */
|
|
||||||
Res = mod_load (&ctrl);
|
|
||||||
|
|
||||||
/* Close the input file */
|
|
||||||
close (ctrl.callerdata);
|
|
||||||
|
|
||||||
/* Check the return code */
|
|
||||||
if (Res == MLOAD_OK) {
|
|
||||||
|
|
||||||
/* Check the driver signature, install the driver */
|
|
||||||
Res = mouse_install (c, ctrl.module);
|
|
||||||
|
|
||||||
/* If the driver did not install correctly, remove it from
|
|
||||||
* memory again.
|
|
||||||
*/
|
|
||||||
if (Res != MOUSE_ERR_OK) {
|
|
||||||
/* Do not call mouse_uninstall here, since the driver is not
|
|
||||||
* correctly installed.
|
|
||||||
*/
|
|
||||||
mod_free (mouse_drv);
|
|
||||||
mouse_clear_ptr ();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Return the error code */
|
|
||||||
return Res;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Error loading the driver */
|
|
||||||
return MOUSE_ERR_CANNOT_LOAD;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
123
libsrc/mouse/mouse_load.s
Normal file
123
libsrc/mouse/mouse_load.s
Normal file
@@ -0,0 +1,123 @@
|
|||||||
|
;
|
||||||
|
; Ullrich von Bassewitz, 2006-06-05
|
||||||
|
;
|
||||||
|
; unsigned char __fastcall__ mouse_load_driver (const struct mouse_callbacks* c,
|
||||||
|
; const char* name)
|
||||||
|
; /* Load a mouse driver and return an error code */
|
||||||
|
|
||||||
|
|
||||||
|
.include "mouse-kernel.inc"
|
||||||
|
.include "modload.inc"
|
||||||
|
.include "fcntl.inc"
|
||||||
|
|
||||||
|
.import pushax
|
||||||
|
.import pusha0
|
||||||
|
.import incsp2
|
||||||
|
.import _open
|
||||||
|
.import _read
|
||||||
|
.import _close
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
;----------------------------------------------------------------------------
|
||||||
|
; Variables
|
||||||
|
|
||||||
|
.data
|
||||||
|
|
||||||
|
ctrl: .addr _read
|
||||||
|
.res 2 ; CALLERDATA
|
||||||
|
.res 2 ; MODULE
|
||||||
|
.res 2 ; MODULE_SIZE
|
||||||
|
.res 2 ; MODULE_ID
|
||||||
|
|
||||||
|
;----------------------------------------------------------------------------
|
||||||
|
; Code
|
||||||
|
|
||||||
|
.code
|
||||||
|
|
||||||
|
.proc _mouse_load_driver
|
||||||
|
|
||||||
|
; Save name on the C stack. We will need it later as parameter passed to open()
|
||||||
|
|
||||||
|
jsr pushax
|
||||||
|
|
||||||
|
; Check if we do already have a driver loaded. If so, remove it.
|
||||||
|
|
||||||
|
lda _mouse_drv
|
||||||
|
ora _mouse_drv+1
|
||||||
|
beq @L1
|
||||||
|
jsr _mouse_uninstall
|
||||||
|
|
||||||
|
; Open the file. The name parameter is already on stack and will get removed
|
||||||
|
; by open().
|
||||||
|
; ctrl.callerdata = open (name, O_RDONLY);
|
||||||
|
|
||||||
|
@L1: lda #<O_RDONLY
|
||||||
|
jsr pusha0
|
||||||
|
ldy #4 ; Argument size
|
||||||
|
jsr _open
|
||||||
|
sta ctrl + MOD_CTRL::CALLERDATA
|
||||||
|
stx ctrl + MOD_CTRL::CALLERDATA+1
|
||||||
|
|
||||||
|
; if (ctrl.callerdata >= 0) {
|
||||||
|
|
||||||
|
txa
|
||||||
|
bmi @L3
|
||||||
|
|
||||||
|
; /* Load the module */
|
||||||
|
; Res = mod_load (&ctrl);
|
||||||
|
|
||||||
|
lda #<ctrl
|
||||||
|
ldx #>ctrl
|
||||||
|
jsr _mod_load
|
||||||
|
pha
|
||||||
|
|
||||||
|
; /* Close the input file */
|
||||||
|
; close (ctrl.callerdata);
|
||||||
|
|
||||||
|
lda ctrl + MOD_CTRL::CALLERDATA
|
||||||
|
ldx ctrl + MOD_CTRL::CALLERDATA+1
|
||||||
|
jsr _close
|
||||||
|
|
||||||
|
; /* Check the return code */
|
||||||
|
; if (Res == MLOAD_OK) {
|
||||||
|
|
||||||
|
pla
|
||||||
|
bne @L3
|
||||||
|
|
||||||
|
; Check the driver signature, install the driver. c is already on stack and
|
||||||
|
; will get removed by mouse_install().
|
||||||
|
; Res = mouse_install (c, ctrl.module);
|
||||||
|
|
||||||
|
lda ctrl + MOD_CTRL::MODULE
|
||||||
|
ldx ctrl + MOD_CTRL::MODULE+1
|
||||||
|
jsr _mouse_install
|
||||||
|
|
||||||
|
; If mouse_install was successful, we're done
|
||||||
|
|
||||||
|
tax
|
||||||
|
beq @L2
|
||||||
|
|
||||||
|
; The driver didn't install correctly. Remove it from memory and return the
|
||||||
|
; error code.
|
||||||
|
|
||||||
|
pha ; Save the error code
|
||||||
|
lda _mouse_drv
|
||||||
|
ldx _mouse_drv+1
|
||||||
|
jsr _mod_free ; Free the driver memory
|
||||||
|
jsr _mouse_clear_ptr ; Clear mouse_drv
|
||||||
|
pla ; Restore the error code
|
||||||
|
ldx #0 ; We must return an int
|
||||||
|
@L2: rts ; Done
|
||||||
|
|
||||||
|
; Open or mod_load failed. Remove excess arguments from stack and return an
|
||||||
|
; error code.
|
||||||
|
|
||||||
|
@L3: jsr incsp2
|
||||||
|
lda #<MOUSE_ERR_CANNOT_LOAD
|
||||||
|
ldx #>MOUSE_ERR_CANNOT_LOAD
|
||||||
|
rts
|
||||||
|
|
||||||
|
.endproc
|
||||||
|
|
||||||
|
|
||||||
@@ -1 +0,0 @@
|
|||||||
ser_load.s
|
|
||||||
|
|||||||
@@ -29,12 +29,13 @@ CFLAGS = -Osir -g -T -t $(SYS) --forget-inc-paths -I . -I ../../include
|
|||||||
#--------------------------------------------------------------------------
|
#--------------------------------------------------------------------------
|
||||||
# Object files
|
# Object files
|
||||||
|
|
||||||
C_OBJS = ser_load.o
|
C_OBJS =
|
||||||
|
|
||||||
S_OBJS = ser-kernel.o \
|
S_OBJS = ser-kernel.o \
|
||||||
ser_close.o \
|
ser_close.o \
|
||||||
ser_get.o \
|
ser_get.o \
|
||||||
ser_ioctl.o \
|
ser_ioctl.o \
|
||||||
|
ser_load.o \
|
||||||
ser_open.o \
|
ser_open.o \
|
||||||
ser_put.o \
|
ser_put.o \
|
||||||
ser_status.o \
|
ser_status.o \
|
||||||
|
|||||||
@@ -1,119 +0,0 @@
|
|||||||
/*****************************************************************************/
|
|
||||||
/* */
|
|
||||||
/* ser_load.c */
|
|
||||||
/* */
|
|
||||||
/* Loader module for serial drivers */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* (C) 2003-2006, Ullrich von Bassewitz */
|
|
||||||
/* R<>merstrasse 52 */
|
|
||||||
/* D-70794 Filderstadt */
|
|
||||||
/* EMail: uz@cc65.org */
|
|
||||||
/* */
|
|
||||||
/* */
|
|
||||||
/* This software is provided 'as-is', without any expressed or implied */
|
|
||||||
/* warranty. In no event will the authors be held liable for any damages */
|
|
||||||
/* arising from the use of this software. */
|
|
||||||
/* */
|
|
||||||
/* Permission is granted to anyone to use this software for any purpose, */
|
|
||||||
/* including commercial applications, and to alter it and redistribute it */
|
|
||||||
/* freely, subject to the following restrictions: */
|
|
||||||
/* */
|
|
||||||
/* 1. The origin of this software must not be misrepresented; you must not */
|
|
||||||
/* claim that you wrote the original software. If you use this software */
|
|
||||||
/* in a product, an acknowledgment in the product documentation would be */
|
|
||||||
/* appreciated but is not required. */
|
|
||||||
/* 2. Altered source versions must be plainly marked as such, and must not */
|
|
||||||
/* be misrepresented as being the original software. */
|
|
||||||
/* 3. This notice may not be removed or altered from any source */
|
|
||||||
/* distribution. */
|
|
||||||
/* */
|
|
||||||
/*****************************************************************************/
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
#include <string.h>
|
|
||||||
#include <unistd.h>
|
|
||||||
#include <fcntl.h>
|
|
||||||
#include <modload.h>
|
|
||||||
#include <serial.h>
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/*****************************************************************************/
|
|
||||||
/* Data */
|
|
||||||
/*****************************************************************************/
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Pointer to serial driver, exported from ser-kernel.s */
|
|
||||||
extern void* ser_drv;
|
|
||||||
|
|
||||||
/* Function that clears the driver pointer (ser-kernel.s) */
|
|
||||||
void ser_clear_ptr (void);
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/*****************************************************************************/
|
|
||||||
/* Code */
|
|
||||||
/*****************************************************************************/
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Use static local variables, since the module is not reentrant anyway */
|
|
||||||
#pragma staticlocals (on);
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
unsigned char __fastcall__ ser_load_driver (const char* name)
|
|
||||||
/* Load a serial driver and return an error code */
|
|
||||||
{
|
|
||||||
static struct mod_ctrl ctrl = {
|
|
||||||
read /* Read from disk */
|
|
||||||
};
|
|
||||||
unsigned char Res;
|
|
||||||
|
|
||||||
/* Check if we do already have a driver loaded. If so, remove it. */
|
|
||||||
if (ser_drv != 0) {
|
|
||||||
ser_uninstall ();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Now open the file */
|
|
||||||
ctrl.callerdata = open (name, O_RDONLY);
|
|
||||||
if (ctrl.callerdata >= 0) {
|
|
||||||
|
|
||||||
/* Load the module */
|
|
||||||
Res = mod_load (&ctrl);
|
|
||||||
|
|
||||||
/* Close the input file */
|
|
||||||
close (ctrl.callerdata);
|
|
||||||
|
|
||||||
/* Check the return code */
|
|
||||||
if (Res == MLOAD_OK) {
|
|
||||||
|
|
||||||
/* Check the driver signature, install the driver */
|
|
||||||
Res = ser_install (ctrl.module);
|
|
||||||
|
|
||||||
/* If the driver did not install correctly, remove it from
|
|
||||||
* memory again.
|
|
||||||
*/
|
|
||||||
if (Res != SER_ERR_OK) {
|
|
||||||
/* Do not call ser_uninstall here, since the driver is not
|
|
||||||
* correctly installed.
|
|
||||||
*/
|
|
||||||
mod_free (ser_drv);
|
|
||||||
ser_clear_ptr ();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Return the error code */
|
|
||||||
return Res;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Error loading the driver */
|
|
||||||
return SER_ERR_CANNOT_LOAD;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
121
libsrc/serial/ser_load.s
Normal file
121
libsrc/serial/ser_load.s
Normal file
@@ -0,0 +1,121 @@
|
|||||||
|
;
|
||||||
|
; Ullrich von Bassewitz, 2006-06-05
|
||||||
|
;
|
||||||
|
; unsigned char __fastcall__ ser_load_driver (const char* name)
|
||||||
|
; /* Load a serial driver and return an error code */
|
||||||
|
|
||||||
|
|
||||||
|
.include "ser-kernel.inc"
|
||||||
|
.include "ser-error.inc"
|
||||||
|
.include "modload.inc"
|
||||||
|
.include "fcntl.inc"
|
||||||
|
|
||||||
|
.import pushax
|
||||||
|
.import pusha0
|
||||||
|
.import incsp2
|
||||||
|
.import _open
|
||||||
|
.import _read
|
||||||
|
.import _close
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
;----------------------------------------------------------------------------
|
||||||
|
; Variables
|
||||||
|
|
||||||
|
.data
|
||||||
|
|
||||||
|
ctrl: .addr _read
|
||||||
|
.res 2 ; CALLERDATA
|
||||||
|
.res 2 ; MODULE
|
||||||
|
.res 2 ; MODULE_SIZE
|
||||||
|
.res 2 ; MODULE_ID
|
||||||
|
|
||||||
|
;----------------------------------------------------------------------------
|
||||||
|
; Code
|
||||||
|
|
||||||
|
.code
|
||||||
|
|
||||||
|
.proc _ser_load_driver
|
||||||
|
|
||||||
|
; Save name on the C stack. We will need it later as parameter passed to open()
|
||||||
|
|
||||||
|
jsr pushax
|
||||||
|
|
||||||
|
; Check if we do already have a driver loaded. If so, remove it.
|
||||||
|
|
||||||
|
lda _ser_drv
|
||||||
|
ora _ser_drv+1
|
||||||
|
beq @L1
|
||||||
|
jsr _ser_uninstall
|
||||||
|
|
||||||
|
; Open the file. The name parameter is already on stack and will get removed
|
||||||
|
; by open().
|
||||||
|
; ctrl.callerdata = open (name, O_RDONLY);
|
||||||
|
|
||||||
|
@L1: lda #<O_RDONLY
|
||||||
|
jsr pusha0
|
||||||
|
ldy #4 ; Argument size
|
||||||
|
jsr _open
|
||||||
|
sta ctrl + MOD_CTRL::CALLERDATA
|
||||||
|
stx ctrl + MOD_CTRL::CALLERDATA+1
|
||||||
|
|
||||||
|
; if (ctrl.callerdata >= 0) {
|
||||||
|
|
||||||
|
txa
|
||||||
|
bmi @L3
|
||||||
|
|
||||||
|
; /* Load the module */
|
||||||
|
; Res = mod_load (&ctrl);
|
||||||
|
|
||||||
|
lda #<ctrl
|
||||||
|
ldx #>ctrl
|
||||||
|
jsr _mod_load
|
||||||
|
pha
|
||||||
|
|
||||||
|
; /* Close the input file */
|
||||||
|
; close (ctrl.callerdata);
|
||||||
|
|
||||||
|
lda ctrl + MOD_CTRL::CALLERDATA
|
||||||
|
ldx ctrl + MOD_CTRL::CALLERDATA+1
|
||||||
|
jsr _close
|
||||||
|
|
||||||
|
; /* Check the return code */
|
||||||
|
; if (Res == MLOAD_OK) {
|
||||||
|
|
||||||
|
pla
|
||||||
|
bne @L3
|
||||||
|
|
||||||
|
; Check the driver signature, install the driver. c is already on stack and
|
||||||
|
; will get removed by ser_install().
|
||||||
|
; Res = ser_install (ctrl.module);
|
||||||
|
|
||||||
|
lda ctrl + MOD_CTRL::MODULE
|
||||||
|
ldx ctrl + MOD_CTRL::MODULE+1
|
||||||
|
jsr _ser_install
|
||||||
|
|
||||||
|
; If ser_install was successful, we're done
|
||||||
|
|
||||||
|
tax
|
||||||
|
beq @L2
|
||||||
|
|
||||||
|
; The driver didn't install correctly. Remove it from memory and return the
|
||||||
|
; error code.
|
||||||
|
|
||||||
|
pha ; Save the error code
|
||||||
|
lda _ser_drv
|
||||||
|
ldx _ser_drv+1
|
||||||
|
jsr _mod_free ; Free the driver memory
|
||||||
|
jsr _ser_clear_ptr ; Clear ser_drv
|
||||||
|
pla ; Restore the error code
|
||||||
|
ldx #0 ; We must return an int
|
||||||
|
@L2: rts ; Done
|
||||||
|
|
||||||
|
; Open or mod_load failed. Return an error code.
|
||||||
|
|
||||||
|
@L3: lda #<SER_ERR_CANNOT_LOAD
|
||||||
|
ldx #>SER_ERR_CANNOT_LOAD
|
||||||
|
rts
|
||||||
|
|
||||||
|
.endproc
|
||||||
|
|
||||||
|
|
||||||
Reference in New Issue
Block a user