usb_hardware.c

/* This file is part of ukbdc.
 *
 * ukbdc is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * ukbdc is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with ukbdc; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 */

#include <avr/pgmspace.h>

#include "usb_hardware.h"
#include "usb_config.h"
#include "usb.h"
#include "auxiliary.h"

void USB_OUT_read_buffer(void *ptr, uint8_t len)
{
	while (len-- > 0)
		*((uint8_t*)ptr++) = USB_OUT_read_byte();
}

void USB_IN_write_buffer(const void *ptr, uint8_t len)
{
	while (len-- > 0)
		USB_IN_write_byte(*(uint8_t*)ptr++);
}
void USB_IN_write_buffer_P(const uint8_t *ptr, uint8_t len)
{
	while (len-- > 0)
		USB_IN_write_byte(pgm_read_byte(ptr++));
}

bool USB_write_blob(const void *ptr, uint16_t len,
		uint16_t ep_size, bool progmem)
{
	while (len > 0) {
		/* wait for readiness or for abort OUT packet */
		while (bit_is_clear(UEINTX, TXINI) &&
				bit_is_clear(UEINTX, RXOUTI))
			;
		if (bit_is_set(UEINTX, RXOUTI)) {
			/* received OUT ZLP (abort) */
			USB_flush_OUT();
			return false;
		}
		uint16_t packet_len = 0;
		if (len <= ep_size)
			packet_len = len;
		else
			packet_len = ep_size;
		if (progmem)
			USB_IN_write_buffer_P(ptr, packet_len);
		else
			USB_IN_write_buffer(ptr, packet_len);
		USB_flush_IN();
		ptr = (uint8_t*)ptr + packet_len;
		len -= packet_len;
	}
	return true;
}

bool USB_configure_endpoint(uint8_t num)
{
	uint8_t i = 0;
	for (; i < NUM_ENDPOINTS; ++i) {
		uint8_t cur_num = get_pgm_struct_field(&endpoint_configs[i], num);
		if (cur_num == num)
			break;
	}
	if (i >= NUM_ENDPOINTS)
		return false;
	UENUM   = get_pgm_struct_field(&endpoint_configs[i], num);
	UECONX  = _BV(EPEN);
	UECFG0X = get_pgm_struct_field(&endpoint_configs[i], type);
	UECFG1X = get_pgm_struct_field(&endpoint_configs[i], config);
	if (bit_is_clear(UESTA0X, CFGOK))
		return false;
	/* set interrupt enable bits */
	UEIENX  = get_pgm_struct_field(&endpoint_configs[i], int_flags);
	return true;
}