Back to home page

LXR

 
 

    


File indexing completed on 2025-05-11 08:23:44

0001 /*  usbinput.c
0002  *
0003  *  Milkymist USB input devices driver for RTEMS
0004  *
0005  *  The license and distribution terms for this file may be
0006  *  found in the file LICENSE in this distribution or at
0007  *  http://www.rtems.org/license/LICENSE.
0008  *
0009  *  COPYRIGHT (c) 2010, 2011, 2012 Sebastien Bourdeauducq
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 }