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
84
85
|
#include "libmaple.h"
#include "usb.h"
#include "usb_regs.h"
#include "bootVect.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(uint8 *pbUsrBuf, uint16 wPMABufAddr, uint16 wNBytes)
{
uint32 n = (wNBytes + 1) >> 1; /* n = (wNBytes + 1) / 2 */
uint32 i, temp1, temp2;
uint16 *pdwVal;
pdwVal = (uint16 *)(wPMABufAddr * 2 + PMAAddr);
for (i = n; i != 0; i--)
{
temp1 = (uint16) * pbUsrBuf;
pbUsrBuf++;
temp2 = temp1 | (uint16) * pbUsrBuf << 8;
*pdwVal++ = temp2;
pdwVal++;
pbUsrBuf++;
}
}
void usb_PMAToUserBufferCopy(uint8 *pbUsrBuf, uint16 wPMABufAddr, uint16 wNBytes)
{
uint32 n = (wNBytes + 1) >> 1;/* /2*/
uint32 i;
uint32 *pdwVal;
pdwVal = (uint32 *)(wPMABufAddr * 2 + PMAAddr);
for (i = n; i != 0; i--)
{
*(uint16*)pbUsrBuf++ = *pdwVal++;
pbUsrBuf++;
}
}
void usb_serialWriteStr(const char* outStr) {
uint8 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 = (uint32*) &offset;
usb_userToPMABufferCopy((uint8*)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((uint8*)(&ch),USB_SERIAL_ENDP_TXADDR,1);
_SetEPTxCount(USB_SERIAL_ENDP_TX,1);
_SetEPTxValid(USB_SERIAL_ENDP_TX);
}
uint8 usb_serialGetRecvLen() {
uint8 count_out =_GetEPRxCount(USB_SERIAL_ENDP_RX);
return count_out;
}
void usb_copyRecvBuffer(unsigned char* dest, uint8 len) {
ASSERT(len < USB_SERIAL_BUF_SIZE);
usb_PMAToUserBufferCopy((uint8*)(dest),USB_SERIAL_ENDP_RXADDR,len);
_SetEPRxValid(USB_SERIAL_ENDP_RX);
}
|
