1433d6423SLionel Sambuc #include "floppy.h"
2433d6423SLionel Sambuc
3433d6423SLionel Sambuc /* State management variables. */
4433d6423SLionel Sambuc EXTERN u16_t f_busy;
5433d6423SLionel Sambuc EXTERN int motor_status;
6433d6423SLionel Sambuc EXTERN unsigned f_drive;
7433d6423SLionel Sambuc EXTERN int last_was_write;
8433d6423SLionel Sambuc #define BSY_IO 1 /* busy doing I/O */
9433d6423SLionel Sambuc
10433d6423SLionel Sambuc /* State management helpers. */
11433d6423SLionel Sambuc #define IS_REQUEST_PENDING(b) ((b) == BSY_IO)
12433d6423SLionel Sambuc #define IS_READ_PENDING(b, c) \
13433d6423SLionel Sambuc (IS_REQUEST_PENDING((b)) && (c) == DEV_GATHER_S)
14433d6423SLionel Sambuc #define IS_WRITE_PENDING(b, c) \
15433d6423SLionel Sambuc (IS_REQUEST_PENDING((b)) && (c) == DEV_SCATTER_S)
16433d6423SLionel Sambuc #define IS_MOTOR_RUNNING(s, d) ((s) & (1 << (d)))
17433d6423SLionel Sambuc
18433d6423SLionel Sambuc /* Custom states definition. */
19433d6423SLionel Sambuc #define FL_STATE_MOTOR_OFF (SEF_LU_STATE_CUSTOM_BASE + 0)
20433d6423SLionel Sambuc #define FL_STATE_IS_CUSTOM(s) ((s) == FL_STATE_MOTOR_OFF)
21433d6423SLionel Sambuc
22433d6423SLionel Sambuc /*===========================================================================*
23433d6423SLionel Sambuc * sef_cb_lu_prepare *
24433d6423SLionel Sambuc *===========================================================================*/
sef_cb_lu_prepare(int state)25433d6423SLionel Sambuc int sef_cb_lu_prepare(int state)
26433d6423SLionel Sambuc {
27433d6423SLionel Sambuc int is_ready;
28433d6423SLionel Sambuc
29433d6423SLionel Sambuc /* Check if we are ready for the target state. */
30433d6423SLionel Sambuc is_ready = FALSE;
31433d6423SLionel Sambuc switch(state) {
32433d6423SLionel Sambuc /* Standard states. */
33433d6423SLionel Sambuc case SEF_LU_STATE_REQUEST_FREE:
34433d6423SLionel Sambuc case SEF_LU_STATE_PROTOCOL_FREE:
35433d6423SLionel Sambuc is_ready = (!IS_REQUEST_PENDING(f_busy));
36433d6423SLionel Sambuc break;
37433d6423SLionel Sambuc
38433d6423SLionel Sambuc /* Custom states. */
39433d6423SLionel Sambuc case FL_STATE_MOTOR_OFF:
40433d6423SLionel Sambuc is_ready = (!IS_REQUEST_PENDING(f_busy)
41433d6423SLionel Sambuc && !IS_MOTOR_RUNNING(motor_status, f_drive));
42433d6423SLionel Sambuc break;
43433d6423SLionel Sambuc }
44433d6423SLionel Sambuc
45433d6423SLionel Sambuc /* Tell SEF if we are ready. */
46433d6423SLionel Sambuc return is_ready ? OK : ENOTREADY;
47433d6423SLionel Sambuc }
48433d6423SLionel Sambuc
49433d6423SLionel Sambuc /*===========================================================================*
50433d6423SLionel Sambuc * sef_cb_lu_state_isvalid *
51433d6423SLionel Sambuc *===========================================================================*/
sef_cb_lu_state_isvalid(int state,int UNUSED (flags))52*e1f889d2SCristiano Giuffrida int sef_cb_lu_state_isvalid(int state, int UNUSED(flags))
53433d6423SLionel Sambuc {
54433d6423SLionel Sambuc return SEF_LU_STATE_IS_STANDARD(state) || FL_STATE_IS_CUSTOM(state);
55433d6423SLionel Sambuc }
56433d6423SLionel Sambuc
57433d6423SLionel Sambuc /*===========================================================================*
58433d6423SLionel Sambuc * sef_cb_lu_state_dump *
59433d6423SLionel Sambuc *===========================================================================*/
sef_cb_lu_state_dump(int state)60433d6423SLionel Sambuc void sef_cb_lu_state_dump(int state)
61433d6423SLionel Sambuc {
62433d6423SLionel Sambuc sef_lu_dprint("floppy: live update state = %d\n", state);
63433d6423SLionel Sambuc sef_lu_dprint("floppy: f_busy = %d\n", f_busy);
64433d6423SLionel Sambuc sef_lu_dprint("floppy: motor_status = 0x%02X\n", motor_status);
65433d6423SLionel Sambuc sef_lu_dprint("floppy: f_drive = %d\n", f_drive);
66433d6423SLionel Sambuc sef_lu_dprint("floppy: last_was_write = %d\n", last_was_write);
67433d6423SLionel Sambuc
68433d6423SLionel Sambuc sef_lu_dprint("floppy: SEF_LU_STATE_WORK_FREE(%d) reached = %d\n",
69433d6423SLionel Sambuc SEF_LU_STATE_WORK_FREE, TRUE);
70433d6423SLionel Sambuc sef_lu_dprint("floppy: SEF_LU_STATE_REQUEST_FREE(%d) reached = %d\n",
71433d6423SLionel Sambuc SEF_LU_STATE_REQUEST_FREE, (!IS_REQUEST_PENDING(f_busy)));
72433d6423SLionel Sambuc sef_lu_dprint("floppy: SEF_LU_STATE_PROTOCOL_FREE(%d) reached = %d\n",
73433d6423SLionel Sambuc SEF_LU_STATE_PROTOCOL_FREE, (!IS_REQUEST_PENDING(f_busy)));
74433d6423SLionel Sambuc sef_lu_dprint("floppy: FL_STATE_MOTOR_OFF(%d) reached = %d\n",
75433d6423SLionel Sambuc FL_STATE_MOTOR_OFF, (!IS_REQUEST_PENDING(f_busy)
76433d6423SLionel Sambuc && !IS_MOTOR_RUNNING(motor_status, f_drive)));
77433d6423SLionel Sambuc }
78433d6423SLionel Sambuc
79