aboutsummaryrefslogtreecommitdiffstats
path: root/libmaple/usb.c
blob: 8c312f8d574e0cc2d3f4e6b6a249f255fb912eb6 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
#include <inttypes.h>
#include "usb.h"

void usb_lpIRQHandler(void)
{
  typedef void (*funcPtr)(void);
  
  const uint32_t usbIsrAddr = *(uint32_t*)(USB_ISR_ADDR);
  void (*ptrToUsbISR)(void) = (funcPtr) usbIsrAddr;
  ptrToUsbISR();
}

void usb_userToPMABufferCopy(u8 *pbUsrBuf, u16 wPMABufAddr, u16 wNBytes)
{
  u32 n = (wNBytes + 1) >> 1;   /* n = (wNBytes + 1) / 2 */
  u32 i, temp1, temp2;
  u16 *pdwVal;
  pdwVal = (u16 *)(wPMABufAddr * 2 + PMAAddr);
  for (i = n; i != 0; i--)
    {
      temp1 = (u16) * pbUsrBuf;
      pbUsrBuf++;
      temp2 = temp1 | (u16) * pbUsrBuf << 8;
      *pdwVal++ = temp2;
      pdwVal++;
      pbUsrBuf++;
    }
}

void usb_PMAToUserBufferCopy(u8 *pbUsrBuf, u16 wPMABufAddr, u16 wNBytes)
{
  u32 n = (wNBytes + 1) >> 1;/* /2*/
  u32 i;
  u32 *pdwVal;
  pdwVal = (u32 *)(wPMABufAddr * 2 + PMAAddr);
  for (i = n; i != 0; i--)
    {
      *(u16*)pbUsrBuf++ = *pdwVal++;
      pbUsrBuf++;
    }
}

void usb_serialWriteStr(const char* outStr) {
  u8 offset=0;
  BootVectTable *bootVector = ((BootVectTable*)BOOTLOADER_VECT_TABLE);

  while ((outStr[offset] != '\0')
	 && (offset < USB_SERIAL_BUF_SIZE)) {
    offset++;
  }

  delay(offset*1);

  bootVector->serial_count_in = (u32*) &offset;
  usb_userToPMABufferCopy((u8*)outStr,USB_SERIAL_ENDP_TXADDR,offset);
  _SetEPTxCount(USB_SERIAL_ENDP_TX,offset);
  _SetEPTxValid(USB_SERIAL_ENDP_TX);

}

void usb_serialWriteChar(unsigned char ch) {
  BootVectTable *bootVector = ((BootVectTable*)BOOTLOADER_VECT_TABLE);

  delay(1);

  *(bootVector->serial_count_in) = 1;
  usb_userToPMABufferCopy((u8*)(&ch),USB_SERIAL_ENDP_TXADDR,1);
  _SetEPTxCount(USB_SERIAL_ENDP_TX,1);
  _SetEPTxValid(USB_SERIAL_ENDP_TX);

}

uint8_t usb_serialGetRecvLen() {
  uint8_t count_out =_GetEPRxCount(USB_SERIAL_ENDP_RX); 
  return count_out;
}

void usb_copyRecvBuffer(unsigned char* dest, uint8_t len) {
  ASSERT(len < USB_SERIAL_BUF_SIZE);
  usb_PMAToUserBufferCopy((u8*)(dest),USB_SERIAL_ENDP_RXADDR,len);
  _SetEPRxValid(USB_SERIAL_ENDP_RX);
}