lora-irrigation/misc.c

/*-
 * Copyright 2021 John-Mark Gurney.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 */

#include "misc.h"

#include <stdarg.h>

#include <usbd_cdc_if.h>
#include <usb_device.h>

static volatile uint32_t holding;
void
Error_Handler(void)
{
	debug_printf("error_handler\n");
	for (;;) holding++;
}

/*
 * Wait for a device to connect to the VCP
 */
void
wait_for_vcp(void)
{

	for (;;) {
		if (vcp_status())
			break;
	}
}

#if MEM_DEBUG_BUF
static char debugbuf[1024];
static uint32_t debugpos = 0;

void
debug_printf(const char *format, ...)
{
	char buf[128];
	char *pos;
	va_list args;
	uint32_t length;
	uint32_t cpy;

	va_start(args, format);
	length = vsnprintf(buf, sizeof buf, format, args);
	va_end(args);

	pos = &buf[0];
	while (length) {
		cpy = MIN(length, sizeof debugbuf - debugpos);
		memcpy(&debugbuf[debugpos], pos, cpy);

		debugpos += cpy;
		if (debugpos >= sizeof debugbuf)
			debugpos = 0;

		pos += cpy;
		length -= cpy;
	}
}
#endif