File indexing completed on 2025-05-11 08:23:44
0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012 #define RTEMS_STATUS_CHECKS_USE_PRINTK
0013
0014 #include <stdlib.h>
0015 #include <stdio.h>
0016 #include <errno.h>
0017 #include <sys/types.h>
0018 #include <rtems.h>
0019 #include <bsp.h>
0020 #include <bsp/irq-generic.h>
0021 #include <rtems/libio.h>
0022 #include <rtems/status-checks.h>
0023 #include "../include/system_conf.h"
0024 #include <bsp/milkymist_usbinput.h>
0025
0026 #include "comloc.h"
0027
0028 #define DEVICE_NAME "/dev/usbinput"
0029
0030 static int mouse_consume;
0031 static int keyboard_consume;
0032 static int midi_consume;
0033
0034 static rtems_id event_q;
0035
0036 static rtems_isr interrupt_handler(rtems_vector_number n)
0037 {
0038 unsigned char msg[8];
0039 int i;
0040
0041 lm32_interrupt_ack(1 << MM_IRQ_USB);
0042
0043 while(mouse_consume != COMLOC_MEVT_PRODUCE) {
0044 for(i=0;i<4;i++)
0045 msg[i] = COMLOC_MEVT(4*mouse_consume+i);
0046 rtems_message_queue_send(event_q, msg, 4);
0047 mouse_consume = (mouse_consume + 1) & 0x0f;
0048 }
0049
0050 while(keyboard_consume != COMLOC_KEVT_PRODUCE) {
0051 for(i=0;i<8;i++)
0052 msg[i] = COMLOC_KEVT(8*keyboard_consume+i);
0053 rtems_message_queue_send(event_q, msg, 8);
0054 keyboard_consume = (keyboard_consume + 1) & 0x07;
0055 }
0056
0057 while(midi_consume != COMLOC_MIDI_PRODUCE) {
0058 for(i=0;i<3;i++)
0059 msg[i] = COMLOC_MIDI(4*midi_consume+i+1);
0060 rtems_message_queue_send(event_q, msg, 3);
0061 midi_consume = (midi_consume + 1) & 0x0f;
0062 }
0063
0064 }
0065
0066 rtems_device_driver usbinput_initialize(
0067 rtems_device_major_number major,
0068 rtems_device_minor_number minor,
0069 void *arg
0070 )
0071 {
0072 rtems_status_code sc;
0073 rtems_isr_entry dummy;
0074
0075 MM_WRITE(MM_SOFTUSB_CONTROL, SOFTUSB_CONTROL_RESET);
0076
0077 mouse_consume = 0;
0078 keyboard_consume = 0;
0079 midi_consume = 0;
0080
0081 sc = rtems_io_register_name(DEVICE_NAME, major, 0);
0082 RTEMS_CHECK_SC(sc, "create USB input device");
0083
0084 sc = rtems_message_queue_create(
0085 rtems_build_name('U', 'S', 'B', 'I'),
0086 64,
0087 8,
0088 0,
0089 &event_q
0090 );
0091 RTEMS_CHECK_SC(sc, "create USB event queue");
0092
0093 rtems_interrupt_catch(interrupt_handler, MM_IRQ_USB, &dummy);
0094 bsp_interrupt_vector_enable(MM_IRQ_USB);
0095
0096 return RTEMS_SUCCESSFUL;
0097 }
0098
0099 rtems_device_driver usbinput_open(
0100 rtems_device_major_number major,
0101 rtems_device_minor_number minor,
0102 void *arg
0103 )
0104 {
0105 uint32_t count;
0106
0107 rtems_message_queue_flush(event_q, &count);
0108 return RTEMS_SUCCESSFUL;
0109 }
0110
0111 rtems_device_driver usbinput_read(
0112 rtems_device_major_number major,
0113 rtems_device_minor_number minor,
0114 void *arg
0115 )
0116 {
0117 rtems_libio_rw_args_t *rw_args = (rtems_libio_rw_args_t *)arg;
0118 rtems_status_code sc;
0119
0120 if(rw_args->count < 8) {
0121 rw_args->bytes_moved = 0;
0122 return RTEMS_UNSATISFIED;
0123 }
0124
0125 sc = rtems_message_queue_receive(
0126 event_q,
0127 rw_args->buffer,
0128 (size_t *)&rw_args->bytes_moved,
0129 RTEMS_WAIT,
0130 RTEMS_NO_TIMEOUT
0131 );
0132
0133 if(sc == RTEMS_SUCCESSFUL)
0134 return RTEMS_SUCCESSFUL;
0135 else {
0136 rw_args->bytes_moved = 0;
0137 return RTEMS_UNSATISFIED;
0138 }
0139 }
0140
0141 static void load_firmware(const unsigned char *firmware, int length)
0142 {
0143 int i, nwords;
0144 volatile unsigned int *usb_dmem
0145 = (volatile unsigned int *)MM_SOFTUSB_DMEM_BASE;
0146 volatile unsigned int *usb_pmem
0147 = (volatile unsigned int *)MM_SOFTUSB_PMEM_BASE;
0148
0149 MM_WRITE(MM_SOFTUSB_CONTROL, SOFTUSB_CONTROL_RESET);
0150 for(i=0;i<SOFTUSB_DMEM_SIZE/4;i++)
0151 usb_dmem[i] = 0;
0152 for(i=0;i<SOFTUSB_PMEM_SIZE/2;i++)
0153 usb_pmem[i] = 0;
0154 nwords = (length+1)/2;
0155 for(i=0;i<nwords;i++)
0156 usb_pmem[i] = ((unsigned int)(firmware[2*i]))
0157 |((unsigned int)(firmware[2*i+1]) << 8);
0158 MM_WRITE(MM_SOFTUSB_CONTROL, 0);
0159 }
0160
0161 rtems_device_driver usbinput_control(
0162 rtems_device_major_number major,
0163 rtems_device_minor_number minor,
0164 void *arg
0165 )
0166 {
0167 rtems_libio_ioctl_args_t *args = arg;
0168 struct usbinput_firmware_description *fd
0169 = (struct usbinput_firmware_description *)args->buffer;
0170
0171 if(args->command == USBINPUT_LOAD_FIRMWARE) {
0172 load_firmware(fd->data, fd->length);
0173 args->ioctl_return = 0;
0174 return RTEMS_SUCCESSFUL;
0175 } else {
0176 args->ioctl_return = -1;
0177 return RTEMS_UNSATISFIED;
0178 }
0179 }