d8fa82cb91
Almost nothing changes here except moving braces to the same line as the function declaration. Everything else is largely whitespace changes and a few dangling files with tab indents. See scripts/codestyle
159 lines
3.7 KiB
C
159 lines
3.7 KiB
C
/* mdebug.c
|
|
*
|
|
* Copyright 2015 Brian Swetland <swetland@frotz.net>
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
|
|
#include <app.h>
|
|
#include <lk/debug.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <printf.h>
|
|
#include <dev/udc.h>
|
|
|
|
#include <platform.h>
|
|
#include <arch/arm.h>
|
|
#include <kernel/thread.h>
|
|
#include <kernel/event.h>
|
|
|
|
#include <platform/lpc43xx-gpio.h>
|
|
|
|
#include "swd.h"
|
|
|
|
#define TX_AHEAD 1
|
|
|
|
static event_t txevt = EVENT_INITIAL_VALUE(txevt, TX_AHEAD, 0);
|
|
static event_t rxevt = EVENT_INITIAL_VALUE(rxevt, 0, 0);
|
|
|
|
static udc_request_t *txreq;
|
|
static udc_request_t *rxreq;
|
|
static udc_endpoint_t *txept;
|
|
static udc_endpoint_t *rxept;
|
|
|
|
static volatile int online;
|
|
static volatile int txstatus;
|
|
static volatile int rxstatus;
|
|
static volatile int rxactual;
|
|
|
|
static void mdebug_notify(udc_gadget_t *gadget, unsigned event) {
|
|
if (event == UDC_EVENT_ONLINE) {
|
|
online = 1;
|
|
} else {
|
|
online = 0;
|
|
}
|
|
}
|
|
|
|
static void rx_complete(udc_request_t *req, unsigned actual, int status) {
|
|
rxactual = actual;
|
|
rxstatus = status;
|
|
event_signal(&rxevt, 0);
|
|
}
|
|
|
|
static void tx_complete(udc_request_t *req, unsigned actual, int status) {
|
|
txstatus = status;
|
|
event_signal(&txevt, 0);
|
|
}
|
|
|
|
#if TX_AHEAD
|
|
void usb_xmit(void *data, unsigned len) {
|
|
event_wait(&txevt);
|
|
event_unsignal(&txevt);
|
|
txreq->buffer = data;
|
|
txreq->length = len;
|
|
txstatus = 1;
|
|
if (udc_request_queue(txept, txreq)) {
|
|
printf("txqf\n");
|
|
event_signal(&txevt, 0);
|
|
}
|
|
}
|
|
#else
|
|
void usb_xmit(void *data, unsigned len) {
|
|
event_unsignal(&txevt);
|
|
txreq->buffer = data;
|
|
txreq->length = len;
|
|
txstatus = 1;
|
|
if (udc_request_queue(txept, txreq) == 0) {
|
|
event_wait(&txevt);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
int usb_recv(void *data, unsigned len) {
|
|
event_unsignal(&rxevt);
|
|
rxreq->buffer = data;
|
|
rxreq->length = len;
|
|
rxstatus = 1;
|
|
if (udc_request_queue(rxept, rxreq)) {
|
|
printf("rxqf\n");
|
|
return -1;
|
|
}
|
|
event_wait(&rxevt);
|
|
return rxstatus ? rxstatus : rxactual;
|
|
}
|
|
|
|
static udc_device_t mdebug_device = {
|
|
.vendor_id = 0x1209,
|
|
.product_id = 0x5038,
|
|
.version_id = 0x0100,
|
|
};
|
|
|
|
static udc_endpoint_t *mdebug_endpoints[2];
|
|
|
|
static udc_gadget_t mdebug_gadget = {
|
|
.notify = mdebug_notify,
|
|
.ifc_class = 0xFF,
|
|
.ifc_subclass = 0xFF,
|
|
.ifc_protocol = 0xFF,
|
|
.ifc_endpoints = 2,
|
|
.ept = mdebug_endpoints,
|
|
};
|
|
|
|
static void mdebug_init(const struct app_descriptor *app) {
|
|
swd_init();
|
|
|
|
udc_init(&mdebug_device);
|
|
mdebug_endpoints[0] = txept = udc_endpoint_alloc(UDC_BULK_IN, 512);
|
|
mdebug_endpoints[1] = rxept = udc_endpoint_alloc(UDC_BULK_OUT, 512);
|
|
txreq = udc_request_alloc();
|
|
rxreq = udc_request_alloc();
|
|
rxreq->complete = rx_complete;
|
|
txreq->complete = tx_complete;
|
|
udc_register_gadget(&mdebug_gadget);
|
|
}
|
|
|
|
void handle_rswd(void);
|
|
void swo_init(udc_endpoint_t *ept);
|
|
void swo_config(unsigned mhz);
|
|
|
|
static void mdebug_entry(const struct app_descriptor *app, void *args) {
|
|
udc_start();
|
|
swo_init(txept);
|
|
swo_config(6000000);
|
|
|
|
for (;;) {
|
|
if (!online) {
|
|
thread_yield();
|
|
continue;
|
|
}
|
|
handle_rswd();
|
|
}
|
|
}
|
|
|
|
APP_START(usbtest)
|
|
.init = mdebug_init,
|
|
.entry = mdebug_entry,
|
|
APP_END
|
|
|
|
|