Subversion Repositories HelenOS-historic

Rev

Rev 1343 | Rev 1345 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1343 Rev 1344
Line 50... Line 50...
50
    int res;
50
    int res;
51
    int c;
51
    int c;
52
    ipcarg_t phonead;
52
    ipcarg_t phonead;
53
   
53
   
54
    ipcarg_t retval, arg1, arg2;
54
    ipcarg_t retval, arg1, arg2;
55
   
55
 
-
 
56
    /* Counter of unsatisfied calls */
56
    fifo_count_t callers_counter = 0;
57
    fifo_count_t callers_counter = 0;
57
   
-
 
-
 
58
    /* Fifo with callid's of unsatisfied calls requred for answer */
58
    FIFO_INITIALIZE_STATIC(callers_buffer, ipc_callid_t, KBD_REQUEST_MAX);
59
    FIFO_INITIALIZE_STATIC(callers_buffer, ipc_callid_t, KBD_REQUEST_MAX);
59
 
60
 
60
    printf("Uspace kbd service started.\n");
61
    printf("Uspace kbd service started.\n");
61
 
62
 
62
    /* Initialize arch dependent parts */
63
    /* Initialize arch dependent parts */
Line 78... Line 79...
78
   
79
   
79
    while (1) {
80
    while (1) {
80
        callid = ipc_wait_for_call(&call, 0);
81
        callid = ipc_wait_for_call(&call, 0);
81
    //  printf("%s:Call phone=%lX..", NAME, call.in_phone_hash);
82
    //  printf("%s:Call phone=%lX..", NAME, call.in_phone_hash);
82
        switch (IPC_GET_METHOD(call)) {
83
        switch (IPC_GET_METHOD(call)) {
83
        case IPC_M_PHONE_HUNGUP:
84
            case IPC_M_PHONE_HUNGUP:
84
            if (connected) {
85
                if (connected) {
-
 
86
                    /* If nobody's connected, clear keybuffer and dont store new keys */
85
                if (--connected == 0) {
87
                    if (--connected == 0) {
86
                    callers_counter = 0;
88
                        callers_counter = 0;
87
                    callers_buffer.head = callers_buffer.tail = 0;
89
                        callers_buffer.head = callers_buffer.tail = 0;
88
                    key_buffer_free(); 
90
                        key_buffer_free(); 
-
 
91
                    }
-
 
92
                   
-
 
93
                    printf("%s: Phone hung up.\n", NAME);
-
 
94
                } else {
-
 
95
                    printf("%s: Oops, got phone hung up, but nobody connected.\n", NAME);
89
                }
96
                }
90
            }
97
               
91
           
-
 
92
            printf("%s: Phone hung up.\n", NAME);
-
 
93
            retval = 0;
-
 
94
            break;
-
 
95
        case IPC_M_CONNECT_TO_ME:
-
 
96
            printf("%s: Somebody connecting phid=%zd.\n", NAME, IPC_GET_ARG3(call));
-
 
97
            retval = 0;
-
 
98
            break;
-
 
99
        case IPC_M_CONNECT_ME_TO:
-
 
100
        //  printf("%s: Connect me (%P) to: %zd\n",NAME, IPC_GET_ARG3(call), IPC_GET_ARG1(call));
-
 
101
            if (connected) {
-
 
102
                retval = ELIMIT;
-
 
103
            } else {
-
 
104
                retval = 0;
98
                retval = 0;
105
                connected = 1;
-
 
106
            }
-
 
107
            break;
99
                break;
108
        case IPC_M_INTERRUPT:
100
            case IPC_M_CONNECT_TO_ME:
109
            if (connected) {
-
 
110
                kbd_arch_process(IPC_GET_ARG2(call));
-
 
111
            }
-
 
112
            //printf("%s: GOT INTERRUPT: %c\n", NAME, IPC_GET_ARG2(call));
101
                printf("%s: Somebody connecting phid=%zd.\n", NAME, IPC_GET_ARG3(call));
113
            if (!callers_counter)
102
                retval = 0;
114
                break;
103
                break;
115
            /* Small trick - interrupt does not need answer so we can change callid to caller awaiting key */
-
 
116
            callers_counter--;
-
 
117
            callid = fifo_pop(callers_buffer);
-
 
118
        case KBD_GETCHAR:
104
            case IPC_M_CONNECT_ME_TO:
119
//          printf("%s: Getchar: ", NAME);
105
            //  printf("%s: Connect me (%P) to: %zd\n",NAME, IPC_GET_ARG3(call), IPC_GET_ARG1(call));
120
            retval = 0;
-
 
121
            arg1 = 0;  
-
 
122
            if (!key_buffer_pop((char *)&arg1)) {
-
 
123
                if (callers_counter < KBD_REQUEST_MAX) {
-
 
124
                    callers_counter++;
-
 
125
                    fifo_push(callers_buffer, callid);
106
                /* Only one connected client allowed */
126
                } else {
107
                if (connected) {
127
                    retval = ELIMIT;
108
                    retval = ELIMIT;
-
 
109
                } else {
-
 
110
                    retval = 0;
-
 
111
                    connected = 1;
128
                }
112
                }
-
 
113
                break;
-
 
114
            case IPC_M_INTERRUPT:
-
 
115
                if (connected) {
-
 
116
                    /* recode scancode and store it into key buffer */
-
 
117
                    kbd_arch_process(IPC_GET_ARG2(call));
-
 
118
                    //printf("%s: GOT INTERRUPT: %c\n", NAME, IPC_GET_ARG2(call));
-
 
119
 
-
 
120
                    /* Some callers could awaiting keypress - if its true, we have to send keys to them.
-
 
121
                     * One interrupt can store more than one key into buffer. */
-
 
122
                    retval = 0;
-
 
123
                    arg2 = 0xbeef;
-
 
124
                    while ((callers_counter) && (!key_buffer_empty())) {
-
 
125
                        callers_counter--;
-
 
126
                        if (!key_buffer_pop((char *)&arg1)) {
-
 
127
                            printf("%s: KeyBuffer empty but it should not be.\n");
-
 
128
                            break;
-
 
129
                        }
-
 
130
                        ipc_answer_fast(fifo_pop(callers_buffer), retval, arg1, arg2);
-
 
131
                    }
-
 
132
                }
-
 
133
                break;
-
 
134
            case KBD_GETCHAR:
-
 
135
    //          printf("%s: Getchar: ", NAME);
-
 
136
                retval = 0;
-
 
137
                arg1 = 0;  
-
 
138
                if (!key_buffer_pop((char *)&arg1)) {
-
 
139
                    if (callers_counter < KBD_REQUEST_MAX) {
-
 
140
                        callers_counter++;
-
 
141
                        fifo_push(callers_buffer, callid);
-
 
142
                    } else {
-
 
143
                        retval = ELIMIT;
-
 
144
                    }
129
                continue;
145
                    continue;
130
            };
146
                };
131
            arg2 = 0xbeef;
147
                arg2 = 0xbeef;
132
        //  printf("GetChar return %c\n", arg1);
148
            //  printf("GetChar return %c\n", arg1);
133
           
149
               
134
            break;
150
                break;
135
        default:
151
            default:
136
            printf("%s: Unknown method: %zd\n", NAME, IPC_GET_METHOD(call));
152
                printf("%s: Unknown method: %zd\n", NAME, IPC_GET_METHOD(call));
137
            retval = ENOENT;
153
                retval = ENOENT;
138
            break;
154
                break;
139
        }
155
        }
-
 
156
 
140
        if (! (callid & IPC_CALLID_NOTIFICATION)) {
157
        if (! (callid & IPC_CALLID_NOTIFICATION)) {
141
        //  printf("%s: Answering\n", NAME);
-
 
142
            ipc_answer_fast(callid, retval, arg1, arg2);
158
            ipc_answer_fast(callid, retval, arg1, arg2);
143
        }
159
        }
144
    }
160
    }
145
}
161
}
-
 
162