1 files changed, 44 insertions, 0 deletions
diff --git a/pjrc/usb_extra.c b/pjrc/usb_extra.c
new file mode 100644
index 0000000000..9bc0c3f5f3
--- /dev/null
+++ b/pjrc/usb_extra.c
@@ -0,0 +1,44 @@
+#include <avr/interrupt.h>
+#include "usb_extra.h"
+
+
+int8_t usb_extra_send(uint8_t report_id, uint8_t bits)
+{
+	uint8_t intr_state, timeout;
+
+	if (!usb_configured()) return -1;
+	intr_state = SREG;
+	cli();
+	UENUM = EXTRA_ENDPOINT;
+	timeout = UDFNUML + 50;
+	while (1) {
+		// are we ready to transmit?
+		if (UEINTX & (1<<RWAL)) break;
+		SREG = intr_state;
+		// has the USB gone offline?
+		if (!usb_configured()) return -1;
+		// have we waited too long?
+		if (UDFNUML == timeout) return -1;
+		// get ready to try checking again
+		intr_state = SREG;
+		cli();
+		UENUM = EXTRA_ENDPOINT;
+	}
+
+	UEDATX = report_id;
+	UEDATX = bits;
+
+	UEINTX = 0x3A;
+	SREG = intr_state;
+	return 0;
+}
+
+int8_t usb_extra_audio_send(uint8_t bits)
+{
+	return usb_extra_send(1, bits);
+}
+
+int8_t usb_extra_system_send(uint8_t bits)
+{
+	return usb_extra_send(2, bits);
+}