visus
/
teensy-core-4.1
İzle 1
Yıldızla 0
Çatalla 0
Kod Sorunlar 0 Değişiklik İstekleri 0 Sürümler 0 Wiki Aktivite
Teensy 4.1 core updated for C++20
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
43 İşlemeler
2 Dallar
Ağaç: 482a1f2b5f
Dallar Biçim İmleri
${ item.name }
Branş ${ searchTerm } oluştur
'482a1f2b5f'den
${ noResults }
teensy-core-4.1/teensy3/usb_dev.c

971 satır
25KB
Ham Bahset Geçmiş 

  1. /* Teensyduino Core Library

  2.  * http://www.pjrc.com/teensy/

  3.  * Copyright (c) 2013 PJRC.COM, LLC.

  4.  *

  5.  * Permission is hereby granted, free of charge, to any person obtaining

  6.  * a copy of this software and associated documentation files (the

  7.  * "Software"), to deal in the Software without restriction, including

  8.  * without limitation the rights to use, copy, modify, merge, publish,

  9.  * distribute, sublicense, and/or sell copies of the Software, and to

  10.  * permit persons to whom the Software is furnished to do so, subject to

  11.  * the following conditions:

  12.  *

  13.  * 1. The above copyright notice and this permission notice shall be 

  14.  * included in all copies or substantial portions of the Software.

  15.  *

  16.  * 2. If the Software is incorporated into a build system that allows 

  17.  * selection among a list of target devices, then similar target

  18.  * devices manufactured by PJRC.COM must be included in the list of

  19.  * target devices and selectable in the same manner.

  20.  *

  21.  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,

  22.  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF

  23.  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND

  24.  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS

  25.  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN

  26.  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN

  27.  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE

  28.  * SOFTWARE.

  29.  */

  30. 

  31. #include "mk20dx128.h"

  32. //#include "HardwareSerial.h"

  33. #include "usb_dev.h"

  34. #include "usb_mem.h"

  35. 

  36. // buffer descriptor table

  37. 

  38. typedef struct {

  39. 	uint32_t desc;

  40. 	void * addr;

  41. } bdt_t;

  42. 

  43. __attribute__ ((section(".usbdescriptortable"), used))

  44. static bdt_t table[(NUM_ENDPOINTS+1)*4];

  45. 

  46. static usb_packet_t *rx_first[NUM_ENDPOINTS];

  47. static usb_packet_t *rx_last[NUM_ENDPOINTS];

  48. static usb_packet_t *tx_first[NUM_ENDPOINTS];

  49. static usb_packet_t *tx_last[NUM_ENDPOINTS];

  50. uint16_t usb_rx_byte_count_data[NUM_ENDPOINTS];

  51. 

  52. static uint8_t tx_state[NUM_ENDPOINTS];

  53. #define TX_STATE_BOTH_FREE_EVEN_FIRST	0

  54. #define TX_STATE_BOTH_FREE_ODD_FIRST	1

  55. #define TX_STATE_EVEN_FREE		2

  56. #define TX_STATE_ODD_FREE		3

  57. #define TX_STATE_NONE_FREE_EVEN_FIRST	4

  58. #define TX_STATE_NONE_FREE_ODD_FIRST	5

  59. 

  60. #define BDT_OWN		0x80

  61. #define BDT_DATA1	0x40

  62. #define BDT_DATA0	0x00

  63. #define BDT_DTS		0x08

  64. #define BDT_STALL	0x04

  65. #define BDT_PID(n)	(((n) >> 2) & 15)

  66. 

  67. #define BDT_DESC(count, data)	(BDT_OWN | BDT_DTS \

  68. 				| ((data) ? BDT_DATA1 : BDT_DATA0) \

  69. 				| ((count) << 16))

  70. 

  71. #define TX   1

  72. #define RX   0

  73. #define ODD  1

  74. #define EVEN 0

  75. #define DATA0 0

  76. #define DATA1 1

  77. #define index(endpoint, tx, odd) (((endpoint) << 2) | ((tx) << 1) | (odd))

  78. #define stat2bufferdescriptor(stat) (table + ((stat) >> 2))

  79. 

  80. 

  81. static union {

  82.  struct {

  83.   union {

  84.    struct {

  85. 	uint8_t bmRequestType;

  86. 	uint8_t bRequest;

  87.    };

  88. 	uint16_t wRequestAndType;

  89.   };

  90. 	uint16_t wValue;

  91. 	uint16_t wIndex;

  92. 	uint16_t wLength;

  93.  };

  94.  struct {

  95. 	uint32_t word1;

  96. 	uint32_t word2;

  97.  };

  98. } setup;

  99. 

  100. 

  101. #define GET_STATUS		0

  102. #define CLEAR_FEATURE		1

  103. #define SET_FEATURE		3

  104. #define SET_ADDRESS		5

  105. #define GET_DESCRIPTOR		6

  106. #define SET_DESCRIPTOR		7

  107. #define GET_CONFIGURATION	8

  108. #define SET_CONFIGURATION	9

  109. #define GET_INTERFACE		10

  110. #define SET_INTERFACE		11

  111. #define SYNCH_FRAME		12

  112. 

  113. // SETUP always uses a DATA0 PID for the data field of the SETUP transaction.

  114. // transactions in the data phase start with DATA1 and toggle (figure 8-12, USB1.1)

  115. // Status stage uses a DATA1 PID.

  116. 

  117. static uint8_t ep0_rx0_buf[EP0_SIZE] __attribute__ ((aligned (4)));

  118. static uint8_t ep0_rx1_buf[EP0_SIZE] __attribute__ ((aligned (4)));

  119. static const uint8_t *ep0_tx_ptr = NULL;

  120. static uint16_t ep0_tx_len;

  121. static uint8_t ep0_tx_bdt_bank = 0;

  122. static uint8_t ep0_tx_data_toggle = 0;

  123. uint8_t usb_rx_memory_needed = 0;

  124. 

  125. volatile uint8_t usb_configuration = 0;

  126. volatile uint8_t usb_reboot_timer = 0;

  127. 

  128. 

  129. static void endpoint0_stall(void)

  130. {

  131. 	USB0_ENDPT0 = USB_ENDPT_EPSTALL | USB_ENDPT_EPRXEN | USB_ENDPT_EPTXEN | USB_ENDPT_EPHSHK;

  132. }

  133. 

  134. 

  135. static void endpoint0_transmit(const void *data, uint32_t len)

  136. {

  137. #if 0

  138. 	serial_print("tx0:");

  139. 	serial_phex32((uint32_t)data);

  140. 	serial_print(",");

  141. 	serial_phex16(len);

  142. 	serial_print(ep0_tx_bdt_bank ? ", odd" : ", even");

  143. 	serial_print(ep0_tx_data_toggle ? ", d1\n" : ", d0\n");

  144. #endif

  145. 	table[index(0, TX, ep0_tx_bdt_bank)].addr = (void *)data;

  146. 	table[index(0, TX, ep0_tx_bdt_bank)].desc = BDT_DESC(len, ep0_tx_data_toggle);

  147. 	ep0_tx_data_toggle ^= 1;

  148. 	ep0_tx_bdt_bank ^= 1;

  149. }

  150. 

  151. static uint8_t reply_buffer[8];

  152. 

  153. static void usb_setup(void)

  154. {

  155. 	const uint8_t *data = NULL;

  156. 	uint32_t datalen = 0;

  157. 	const usb_descriptor_list_t *list;

  158. 	uint32_t size;

  159. 	volatile uint8_t *reg;

  160. 	uint8_t epconf;

  161. 	const uint8_t *cfg;

  162. 	int i;

  163. 

  164. 	switch (setup.wRequestAndType) {

  165. 	  case 0x0500: // SET_ADDRESS

  166. 		break;

  167. 	  case 0x0900: // SET_CONFIGURATION

  168. 		//serial_print("configure\n");

  169. 		usb_configuration = setup.wValue;

  170. 		reg = &USB0_ENDPT1;

  171. 		cfg = usb_endpoint_config_table;

  172. 		// clear all BDT entries, free any allocated memory...

  173. 		for (i=4; i < (NUM_ENDPOINTS+1)*4; i++) {

  174. 			if (table[i].desc & BDT_OWN) {

  175. 				usb_free((usb_packet_t *)((uint8_t *)(table[i].addr) - 8));

  176. 			}

  177. 		}

  178. 		// free all queued packets

  179. 		for (i=0; i < NUM_ENDPOINTS; i++) {

  180. 			usb_packet_t *p, *n;

  181. 			p = rx_first[i];

  182. 			while (p) {

  183. 				n = p->next;

  184. 				usb_free(p);

  185. 				p = n;

  186. 			}

  187. 			rx_first[i] = NULL;

  188. 			rx_last[i] = NULL;

  189. 			p = tx_first[i];

  190. 			while (p) {

  191. 				n = p->next;

  192. 				usb_free(p);

  193. 				p = n;

  194. 			}

  195. 			tx_first[i] = NULL;

  196. 			tx_last[i] = NULL;

  197. 			usb_rx_byte_count_data[i] = 0;

  198. 			switch (tx_state[i]) {

  199. 			  case TX_STATE_EVEN_FREE:

  200. 			  case TX_STATE_NONE_FREE_EVEN_FIRST:

  201. 				tx_state[i] = TX_STATE_BOTH_FREE_EVEN_FIRST;

  202. 				break;

  203. 			  case TX_STATE_ODD_FREE:

  204. 			  case TX_STATE_NONE_FREE_ODD_FIRST:

  205. 				tx_state[i] = TX_STATE_BOTH_FREE_ODD_FIRST;

  206. 				break;

  207. 			  default:

  208. 				break;

  209. 			}

  210. 		}

  211. 		usb_rx_memory_needed = 0;

  212. 		for (i=1; i <= NUM_ENDPOINTS; i++) {

  213. 			epconf = *cfg++;

  214. 			*reg = epconf;

  215. 			reg += 4;

  216. 			if (epconf & USB_ENDPT_EPRXEN) {

  217. 				usb_packet_t *p;

  218. 				p = usb_malloc();

  219. 				if (p) {

  220. 					table[index(i, RX, EVEN)].addr = p->buf;

  221. 					table[index(i, RX, EVEN)].desc = BDT_DESC(64, 0);

  222. 				} else {

  223. 					table[index(i, RX, EVEN)].desc = 0;

  224. 					usb_rx_memory_needed++;

  225. 				}

  226. 				p = usb_malloc();

  227. 				if (p) {

  228. 					table[index(i, RX, ODD)].addr = p->buf;

  229. 					table[index(i, RX, ODD)].desc = BDT_DESC(64, 1);

  230. 				} else {

  231. 					table[index(i, RX, ODD)].desc = 0;

  232. 					usb_rx_memory_needed++;

  233. 				}

  234. 			}

  235. 			table[index(i, TX, EVEN)].desc = 0;

  236. 			table[index(i, TX, ODD)].desc = 0;

  237. 		}

  238. 		break;

  239. 	  case 0x0880: // GET_CONFIGURATION

  240. 		reply_buffer[0] = usb_configuration;

  241. 		datalen = 1;

  242. 		data = reply_buffer;

  243. 		break;

  244. 	  case 0x0080: // GET_STATUS (device)

  245. 		reply_buffer[0] = 0;

  246. 		reply_buffer[1] = 0;

  247. 		datalen = 2;

  248. 		data = reply_buffer;

  249. 		break;

  250. 	  case 0x0082: // GET_STATUS (endpoint)

  251. 		if (setup.wIndex > NUM_ENDPOINTS) {

  252. 			// TODO: do we need to handle IN vs OUT here?

  253. 			endpoint0_stall();

  254. 			return;

  255. 		}

  256. 		reply_buffer[0] = 0;

  257. 		reply_buffer[1] = 0;

  258. 		if (*(uint8_t *)(&USB0_ENDPT0 + setup.wIndex * 4) & 0x02) reply_buffer[0] = 1;

  259. 		data = reply_buffer;

  260. 		datalen = 2;

  261. 		break;

  262. 	  case 0x0102: // CLEAR_FEATURE (endpoint)

  263. 		i = setup.wIndex & 0x7F;

  264. 		if (i > NUM_ENDPOINTS || setup.wValue != 0) {

  265. 			// TODO: do we need to handle IN vs OUT here?

  266. 			endpoint0_stall();

  267. 			return;

  268. 		}

  269. 		(*(uint8_t *)(&USB0_ENDPT0 + setup.wIndex * 4)) &= ~0x02;

  270. 		// TODO: do we need to clear the data toggle here?

  271. 		break;

  272. 	  case 0x0302: // SET_FEATURE (endpoint)

  273. 		i = setup.wIndex & 0x7F;

  274. 		if (i > NUM_ENDPOINTS || setup.wValue != 0) {

  275. 			// TODO: do we need to handle IN vs OUT here?

  276. 			endpoint0_stall();

  277. 			return;

  278. 		}

  279. 		(*(uint8_t *)(&USB0_ENDPT0 + setup.wIndex * 4)) |= 0x02;

  280. 		// TODO: do we need to clear the data toggle here?

  281. 		break;

  282. 	  case 0x0680: // GET_DESCRIPTOR

  283. 	  case 0x0681:

  284. 		//serial_print("desc:");

  285. 		//serial_phex16(setup.wValue);

  286. 		//serial_print("\n");

  287. 		for (list = usb_descriptor_list; 1; list++) {

  288. 			if (list->addr == NULL) break;

  289. 			//if (setup.wValue == list->wValue && 

  290. 			//(setup.wIndex == list->wIndex) || ((setup.wValue >> 8) == 3)) {

  291. 			if (setup.wValue == list->wValue && setup.wIndex == list->wIndex) {

  292. 				data = list->addr;

  293. 				if ((setup.wValue >> 8) == 3) {

  294. 					// for string descriptors, use the descriptor's

  295. 					// length field, allowing runtime configured

  296. 					// length.

  297. 					datalen = *(list->addr);

  298. 				} else {

  299. 					datalen = list->length;

  300. 				}

  301. #if 0

  302. 				serial_print("Desc found, ");

  303. 				serial_phex32((uint32_t)data);

  304. 				serial_print(",");

  305. 				serial_phex16(datalen);

  306. 				serial_print(",");

  307. 				serial_phex(data[0]);

  308. 				serial_phex(data[1]);

  309. 				serial_phex(data[2]);

  310. 				serial_phex(data[3]);

  311. 				serial_phex(data[4]);

  312. 				serial_phex(data[5]);

  313. 				serial_print("\n");

  314. #endif

  315. 				goto send;

  316. 			}

  317. 		}

  318. 		//serial_print("desc: not found\n");

  319. 		endpoint0_stall();

  320. 		return;

  321. #if defined(CDC_STATUS_INTERFACE)

  322. 	  case 0x2221: // CDC_SET_CONTROL_LINE_STATE

  323. 		usb_cdc_line_rtsdtr = setup.wValue;

  324. 		//serial_print("set control line state\n");

  325. 		break;

  326. 	  case 0x2021: // CDC_SET_LINE_CODING

  327. 		//serial_print("set coding, waiting...\n");

  328. 		return;

  329. #endif

  330. 

  331. // TODO: this does not work... why?

  332. #if defined(SEREMU_INTERFACE) || defined(KEYBOARD_INTERFACE)

  333. 	  case 0x0921: // HID SET_REPORT

  334. 		//serial_print(":)\n");

  335. 		return;

  336. 	  case 0x0A21: // HID SET_IDLE

  337. 		break;

  338. 	  // case 0xC940:

  339. #endif

  340. 	  default:

  341. 		endpoint0_stall();

  342. 		return;

  343. 	}

  344. 	send:

  345. 	//serial_print("setup send ");

  346. 	//serial_phex32(data);

  347. 	//serial_print(",");

  348. 	//serial_phex16(datalen);

  349. 	//serial_print("\n");

  350. 

  351. 	if (datalen > setup.wLength) datalen = setup.wLength;

  352. 	size = datalen;

  353. 	if (size > EP0_SIZE) size = EP0_SIZE;

  354. 	endpoint0_transmit(data, size);

  355. 	data += size;

  356. 	datalen -= size;

  357. 	if (datalen == 0 && size < EP0_SIZE) return;

  358. 

  359. 	size = datalen;

  360. 	if (size > EP0_SIZE) size = EP0_SIZE;

  361. 	endpoint0_transmit(data, size);

  362. 	data += size;

  363. 	datalen -= size;

  364. 	if (datalen == 0 && size < EP0_SIZE) return;

  365. 

  366. 	ep0_tx_ptr = data;

  367. 	ep0_tx_len = datalen;

  368. }

  369. 

  370. 

  371. 

  372. //A bulk endpoint's toggle sequence is initialized to DATA0 when the endpoint

  373. //experiences any configuration event (configuration events are explained in

  374. //Sections 9.1.1.5 and 9.4.5).

  375. 

  376. //Configuring a device or changing an alternate setting causes all of the status

  377. //and configuration values associated with endpoints in the affected interfaces

  378. //to be set to their default values. This includes setting the data toggle of

  379. //any endpoint using data toggles to the value DATA0.

  380. 

  381. //For endpoints using data toggle, regardless of whether an endpoint has the

  382. //Halt feature set, a ClearFeature(ENDPOINT_HALT) request always results in the

  383. //data toggle being reinitialized to DATA0.

  384. 

  385. 

  386. 

  387. // #define stat2bufferdescriptor(stat) (table + ((stat) >> 2))

  388. 

  389. static void usb_control(uint32_t stat)

  390. {

  391. 	bdt_t *b;

  392. 	uint32_t pid, size;

  393. 	uint8_t *buf;

  394. 	const uint8_t *data;

  395. 

  396. 	b = stat2bufferdescriptor(stat);

  397. 	pid = BDT_PID(b->desc);

  398. 	//count = b->desc >> 16;

  399. 	buf = b->addr;

  400. 	//serial_print("pid:");

  401. 	//serial_phex(pid);

  402. 	//serial_print(", count:");

  403. 	//serial_phex(count);

  404. 	//serial_print("\n");

  405. 

  406. 	switch (pid) {

  407. 	case 0x0D: // Setup received from host

  408. 		//serial_print("PID=Setup\n");

  409. 		//if (count != 8) ; // panic?

  410. 		// grab the 8 byte setup info

  411. 		setup.word1 = *(uint32_t *)(buf);

  412. 		setup.word2 = *(uint32_t *)(buf + 4);

  413. 

  414. 		// give the buffer back

  415. 		b->desc = BDT_DESC(EP0_SIZE, DATA1);

  416. 		//table[index(0, RX, EVEN)].desc = BDT_DESC(EP0_SIZE, 1);

  417. 		//table[index(0, RX, ODD)].desc = BDT_DESC(EP0_SIZE, 1);

  418. 

  419. 		// clear any leftover pending IN transactions

  420. 		ep0_tx_ptr = NULL;

  421. 		if (ep0_tx_data_toggle) {

  422. 		}

  423. 		//if (table[index(0, TX, EVEN)].desc & 0x80) {

  424. 			//serial_print("leftover tx even\n");

  425. 		//}

  426. 		//if (table[index(0, TX, ODD)].desc & 0x80) {

  427. 			//serial_print("leftover tx odd\n");

  428. 		//}

  429. 		table[index(0, TX, EVEN)].desc = 0;

  430. 		table[index(0, TX, ODD)].desc = 0;

  431. 		// first IN after Setup is always DATA1

  432. 		ep0_tx_data_toggle = 1;

  433. 

  434. #if 0

  435. 		serial_print("bmRequestType:");

  436. 		serial_phex(setup.bmRequestType);

  437. 		serial_print(", bRequest:");

  438. 		serial_phex(setup.bRequest);

  439. 		serial_print(", wValue:");

  440. 		serial_phex16(setup.wValue);

  441. 		serial_print(", wIndex:");

  442. 		serial_phex16(setup.wIndex);

  443. 		serial_print(", len:");

  444. 		serial_phex16(setup.wLength);

  445. 		serial_print("\n");

  446. #endif

  447. 		// actually "do" the setup request

  448. 		usb_setup();

  449. 		// unfreeze the USB, now that we're ready

  450. 		USB0_CTL = USB_CTL_USBENSOFEN; // clear TXSUSPENDTOKENBUSY bit

  451. 		break;

  452. 	case 0x01:  // OUT transaction received from host

  453. 	case 0x02:

  454. 		//serial_print("PID=OUT\n");

  455. #ifdef CDC_STATUS_INTERFACE

  456. 		if (setup.wRequestAndType == 0x2021 /*CDC_SET_LINE_CODING*/) {

  457. 			int i;

  458. 			uint8_t *dst = (uint8_t *)usb_cdc_line_coding;

  459. 			//serial_print("set line coding ");

  460. 			for (i=0; i<7; i++) {

  461. 				//serial_phex(*buf);

  462. 				*dst++ = *buf++;

  463. 			}

  464. 			//serial_phex32(usb_cdc_line_coding[0]);

  465. 			//serial_print("\n");

  466. 			if (usb_cdc_line_coding[0] == 134) usb_reboot_timer = 15;

  467. 			endpoint0_transmit(NULL, 0);

  468. 		}

  469. #endif

  470. #ifdef KEYBOARD_INTERFACE

  471. 		if (setup.word1 == 0x02000921 && setup.word2 == ((1<<16)|KEYBOARD_INTERFACE)) {

  472. 			keyboard_leds = buf[0];

  473. 			endpoint0_transmit(NULL, 0);

  474. 		}

  475. #endif

  476. #ifdef SEREMU_INTERFACE

  477. 		if (setup.word1 == 0x03000921 && setup.word2 == ((4<<16)|SEREMU_INTERFACE)

  478. 		  && buf[0] == 0xA9 && buf[1] == 0x45 && buf[2] == 0xC2 && buf[3] == 0x6B) {

  479. 			usb_reboot_timer = 5;

  480. 			endpoint0_transmit(NULL, 0);

  481. 		}

  482. #endif

  483. 		// give the buffer back

  484. 		b->desc = BDT_DESC(EP0_SIZE, DATA1);

  485. 		break;

  486. 

  487. 	case 0x09: // IN transaction completed to host

  488. 		//serial_print("PID=IN:");

  489. 		//serial_phex(stat);

  490. 		//serial_print("\n");

  491. 

  492. 		// send remaining data, if any...

  493. 		data = ep0_tx_ptr;

  494. 		if (data) {

  495. 			size = ep0_tx_len;

  496. 			if (size > EP0_SIZE) size = EP0_SIZE;

  497. 			endpoint0_transmit(data, size);

  498. 			data += size;

  499. 			ep0_tx_len -= size;

  500. 			ep0_tx_ptr = (ep0_tx_len > 0 || size == EP0_SIZE) ? data : NULL;

  501. 		}

  502. 

  503. 		if (setup.bRequest == 5 && setup.bmRequestType == 0) {

  504. 			setup.bRequest = 0;

  505. 			//serial_print("set address: ");

  506. 			//serial_phex16(setup.wValue);

  507. 			//serial_print("\n");

  508. 			USB0_ADDR = setup.wValue;

  509. 		}

  510. 

  511. 		break;

  512. 	//default:

  513. 		//serial_print("PID=unknown:");

  514. 		//serial_phex(pid);

  515. 		//serial_print("\n");

  516. 	}

  517. 	USB0_CTL = USB_CTL_USBENSOFEN; // clear TXSUSPENDTOKENBUSY bit

  518. }

  519. 

  520. 

  521. 

  522. 

  523. 

  524. 

  525. usb_packet_t *usb_rx(uint32_t endpoint)

  526. {

  527. 	usb_packet_t *ret;

  528. 	endpoint--;

  529. 	if (endpoint >= NUM_ENDPOINTS) return NULL;

  530. 	__disable_irq();

  531. 	ret = rx_first[endpoint];

  532. 	if (ret) {

  533. 		rx_first[endpoint] = ret->next;

  534. 		usb_rx_byte_count_data[endpoint] -= ret->len;

  535. 	}

  536. 	__enable_irq();

  537. 	//serial_print("rx, epidx=");

  538. 	//serial_phex(endpoint);

  539. 	//serial_print(", packet=");

  540. 	//serial_phex32(ret);

  541. 	//serial_print("\n");

  542. 	return ret;

  543. }

  544. 

  545. static uint32_t usb_queue_byte_count(const usb_packet_t *p)

  546. {

  547. 	uint32_t count=0;

  548. 

  549. 	__disable_irq();

  550. 	for ( ; p; p = p->next) {

  551. 		count += p->len;

  552. 	}

  553. 	__enable_irq();

  554. 	return count;

  555. }

  556. 

  557. // TODO: make this an inline function...

  558. /*

  559. uint32_t usb_rx_byte_count(uint32_t endpoint)

  560. {

  561. 	endpoint--;

  562. 	if (endpoint >= NUM_ENDPOINTS) return 0;

  563. 	return usb_rx_byte_count_data[endpoint];

  564. 	//return usb_queue_byte_count(rx_first[endpoint]);

  565. }

  566. */

  567. 

  568. uint32_t usb_tx_byte_count(uint32_t endpoint)

  569. {

  570. 	endpoint--;

  571. 	if (endpoint >= NUM_ENDPOINTS) return 0;

  572. 	return usb_queue_byte_count(tx_first[endpoint]);

  573. }

  574. 

  575. uint32_t usb_tx_packet_count(uint32_t endpoint)

  576. {

  577. 	const usb_packet_t *p;

  578. 	uint32_t count=0;

  579. 

  580. 	endpoint--;

  581. 	if (endpoint >= NUM_ENDPOINTS) return 0;

  582. 	__disable_irq();

  583. 	for (p = tx_first[endpoint]; p; p = p->next) count++;

  584. 	__enable_irq();

  585. 	return count;

  586. }

  587. 

  588. 

  589. // Called from usb_free, but only when usb_rx_memory_needed > 0, indicating

  590. // receive endpoints are starving for memory.  The intention is to give

  591. // endpoints needing receive memory priority over the user's code, which is

  592. // likely calling usb_malloc to obtain memory for transmitting.  When the

  593. // user is creating data very quickly, their consumption could starve reception

  594. // without this prioritization.  The packet buffer (input) is assigned to the

  595. // first endpoint needing memory.

  596. //

  597. void usb_rx_memory(usb_packet_t *packet)

  598. {

  599. 	unsigned int i;

  600. 	const uint8_t *cfg;

  601. 

  602. 	cfg = usb_endpoint_config_table;

  603. 	//serial_print("rx_mem:");

  604. 	__disable_irq();

  605. 	for (i=1; i <= NUM_ENDPOINTS; i++) {

  606. 		if (*cfg++ & USB_ENDPT_EPRXEN) {

  607. 			if (table[index(i, RX, EVEN)].desc == 0) {

  608. 				table[index(i, RX, EVEN)].addr = packet->buf;

  609. 				table[index(i, RX, EVEN)].desc = BDT_DESC(64, 0);

  610. 				usb_rx_memory_needed--;

  611. 				__enable_irq();

  612. 				//serial_phex(i);

  613. 				//serial_print(",even\n");

  614. 				return;

  615. 			}

  616. 			if (table[index(i, RX, ODD)].desc == 0) {

  617. 				table[index(i, RX, ODD)].addr = packet->buf;

  618. 				table[index(i, RX, ODD)].desc = BDT_DESC(64, 1);

  619. 				usb_rx_memory_needed--;

  620. 				__enable_irq();

  621. 				//serial_phex(i);

  622. 				//serial_print(",odd\n");

  623. 				return;

  624. 			}

  625. 		}

  626. 	}

  627. 	__enable_irq();

  628. 	// we should never reach this point.  If we get here, it means

  629. 	// usb_rx_memory_needed was set greater than zero, but no memory

  630. 	// was actually needed.  

  631. 	usb_rx_memory_needed = 0;

  632. 	usb_free(packet);

  633. 	return;

  634. }

  635. 

  636. //#define index(endpoint, tx, odd) (((endpoint) << 2) | ((tx) << 1) | (odd))

  637. //#define stat2bufferdescriptor(stat) (table + ((stat) >> 2))

  638. 

  639. void usb_tx(uint32_t endpoint, usb_packet_t *packet)

  640. {

  641. 	bdt_t *b = &table[index(endpoint, TX, EVEN)];

  642. 	uint8_t next;

  643. 

  644. 	endpoint--;

  645. 	if (endpoint >= NUM_ENDPOINTS) return;

  646. 	__disable_irq();

  647. 	//serial_print("txstate=");

  648. 	//serial_phex(tx_state[endpoint]);

  649. 	//serial_print("\n");

  650. 	switch (tx_state[endpoint]) {

  651. 	  case TX_STATE_BOTH_FREE_EVEN_FIRST:

  652. 		next = TX_STATE_ODD_FREE;

  653. 		break;

  654. 	  case TX_STATE_BOTH_FREE_ODD_FIRST:

  655. 		b++;

  656. 		next = TX_STATE_EVEN_FREE;

  657. 		break;

  658. 	  case TX_STATE_EVEN_FREE:

  659. 		next = TX_STATE_NONE_FREE_ODD_FIRST;

  660. 		break;

  661. 	  case TX_STATE_ODD_FREE:

  662. 		b++;

  663. 		next = TX_STATE_NONE_FREE_EVEN_FIRST;

  664. 		break;

  665. 	  default:

  666. 		if (tx_first[endpoint] == NULL) {

  667. 			tx_first[endpoint] = packet;

  668. 		} else {

  669. 			tx_last[endpoint]->next = packet;

  670. 		}

  671. 		tx_last[endpoint] = packet;

  672. 		__enable_irq();

  673. 		return;

  674. 	}

  675. 	tx_state[endpoint] = next;

  676. 	b->addr = packet->buf;

  677. 	b->desc = BDT_DESC(packet->len, ((uint32_t)b & 8) ? DATA1 : DATA0);

  678. 	__enable_irq();

  679. }

  680. 

  681. 

  682. 

  683. 

  684. 

  685. 

  686. void _reboot_Teensyduino_(void)

  687. {

  688. 	// TODO: initialize R0 with a code....

  689. 	asm volatile("bkpt");

  690. }

  691. 

  692. 

  693. 

  694. void usb_isr(void)

  695. {

  696. 	uint8_t status, stat, t;

  697. 

  698. 	//serial_print("isr");

  699. 	//status = USB0_ISTAT;

  700. 	//serial_phex(status);

  701. 	//serial_print("\n");

  702. 	restart:

  703. 	status = USB0_ISTAT;

  704. 

  705. 	if ((status & USB_INTEN_SOFTOKEN /* 04 */ )) {

  706. 		if (usb_configuration) {

  707. 			t = usb_reboot_timer;

  708. 			if (t) {

  709. 				usb_reboot_timer = --t;

  710. 				if (!t) _reboot_Teensyduino_();

  711. 			}

  712. #ifdef CDC_DATA_INTERFACE

  713. 			t = usb_cdc_transmit_flush_timer;

  714. 			if (t) {

  715. 				usb_cdc_transmit_flush_timer = --t;

  716. 				if (t == 0) usb_serial_flush_callback();

  717. 			}

  718. #endif

  719. #ifdef SEREMU_INTERFACE

  720. 			t = usb_seremu_transmit_flush_timer;

  721. 			if (t) {

  722. 				usb_seremu_transmit_flush_timer = --t;

  723. 				if (t == 0) usb_seremu_flush_callback();

  724. 			}

  725. #endif

  726. #ifdef MIDI_INTERFACE

  727.                         usb_midi_flush_output();

  728. #endif

  729. #ifdef FLIGHTSIM_INTERFACE

  730. 			usb_flightsim_flush_callback();

  731. #endif

  732. 		}

  733. 		USB0_ISTAT = USB_INTEN_SOFTOKEN;

  734. 	}

  735. 

  736. 	if ((status & USB_ISTAT_TOKDNE /* 08 */ )) {

  737. 		uint8_t endpoint;

  738. 		stat = USB0_STAT;

  739. 		//serial_print("token: ep=");

  740. 		//serial_phex(stat >> 4);

  741. 		//serial_print(stat & 0x08 ? ",tx" : ",rx");

  742. 		//serial_print(stat & 0x04 ? ",odd\n" : ",even\n");

  743. 		endpoint = stat >> 4;

  744. 		if (endpoint == 0) {

  745. 			usb_control(stat);

  746. 		} else {

  747. 			bdt_t *b = stat2bufferdescriptor(stat);

  748. 			usb_packet_t *packet = (usb_packet_t *)((uint8_t *)(b->addr) - 8);

  749. #if 0

  750. 			serial_print("ep:");

  751. 			serial_phex(endpoint);

  752. 			serial_print(", pid:");

  753. 			serial_phex(BDT_PID(b->desc));

  754. 			serial_print(((uint32_t)b & 8) ? ", odd" : ", even");

  755. 			serial_print(", count:");

  756. 			serial_phex(b->desc >> 16);

  757. 			serial_print("\n");

  758. #endif

  759. 			endpoint--;	// endpoint is index to zero-based arrays

  760. 

  761. 			if (stat & 0x08) { // transmit

  762. 				usb_free(packet);

  763. 				packet = tx_first[endpoint];

  764. 				if (packet) {

  765. 					//serial_print("tx packet\n");

  766. 					tx_first[endpoint] = packet->next;

  767. 					b->addr = packet->buf;

  768. 					switch (tx_state[endpoint]) {

  769. 					  case TX_STATE_BOTH_FREE_EVEN_FIRST:

  770. 						tx_state[endpoint] = TX_STATE_ODD_FREE;

  771. 						break;

  772. 					  case TX_STATE_BOTH_FREE_ODD_FIRST:

  773. 						tx_state[endpoint] = TX_STATE_EVEN_FREE;

  774. 						break;

  775. 					  case TX_STATE_EVEN_FREE:

  776. 						tx_state[endpoint] = TX_STATE_NONE_FREE_ODD_FIRST;

  777. 						break;

  778. 					  case TX_STATE_ODD_FREE:

  779. 						tx_state[endpoint] = TX_STATE_NONE_FREE_EVEN_FIRST;

  780. 						break;

  781. 					  default:

  782. 						break;

  783. 					}

  784. 					b->desc = BDT_DESC(packet->len, ((uint32_t)b & 8) ? DATA1 : DATA0);

  785. 				} else {

  786. 					//serial_print("tx no packet\n");

  787. 					switch (tx_state[endpoint]) {

  788. 					  case TX_STATE_BOTH_FREE_EVEN_FIRST:

  789. 					  case TX_STATE_BOTH_FREE_ODD_FIRST:

  790. 						break;

  791. 					  case TX_STATE_EVEN_FREE:

  792. 						tx_state[endpoint] = TX_STATE_BOTH_FREE_EVEN_FIRST;

  793. 						break;

  794. 					  case TX_STATE_ODD_FREE:

  795. 						tx_state[endpoint] = TX_STATE_BOTH_FREE_ODD_FIRST;

  796. 						break;

  797. 					  default:

  798. 						tx_state[endpoint] = ((uint32_t)b & 8) ?

  799. 						  TX_STATE_ODD_FREE : TX_STATE_EVEN_FREE;

  800. 						break;

  801. 					}

  802. 				}

  803. 			} else { // receive

  804. 				packet->len = b->desc >> 16;

  805. 				if (packet->len > 0) {

  806. 					packet->index = 0;

  807. 					packet->next = NULL;

  808. 					if (rx_first[endpoint] == NULL) {

  809. 						//serial_print("rx 1st, epidx=");

  810. 						//serial_phex(endpoint);

  811. 						//serial_print(", packet=");

  812. 						//serial_phex32((uint32_t)packet);

  813. 						//serial_print("\n");

  814. 						rx_first[endpoint] = packet;

  815. 					} else {

  816. 						//serial_print("rx Nth, epidx=");

  817. 						//serial_phex(endpoint);

  818. 						//serial_print(", packet=");

  819. 						//serial_phex32((uint32_t)packet);

  820. 						//serial_print("\n");

  821. 						rx_last[endpoint]->next = packet;

  822. 					}

  823. 					rx_last[endpoint] = packet;

  824. 					usb_rx_byte_count_data[endpoint] += packet->len;

  825. 					// TODO: implement a per-endpoint maximum # of allocated packets

  826. 					// so a flood of incoming data on 1 endpoint doesn't starve

  827. 					// the others if the user isn't reading it regularly

  828. 					packet = usb_malloc();

  829. 					if (packet) {

  830. 						b->addr = packet->buf;

  831. 						b->desc = BDT_DESC(64, ((uint32_t)b & 8) ? DATA1 : DATA0);

  832. 					} else {

  833. 						//serial_print("starving ");

  834. 						//serial_phex(endpoint + 1);

  835. 						//serial_print(((uint32_t)b & 8) ? ",odd\n" : ",even\n");

  836. 						b->desc = 0;

  837. 						usb_rx_memory_needed++;

  838. 					}

  839. 				} else {

  840. 					b->desc = BDT_DESC(64, ((uint32_t)b & 8) ? DATA1 : DATA0);

  841. 				}

  842. 			}

  843. 

  844. 

  845. 

  846. 

  847. 		}

  848. 		USB0_ISTAT = USB_ISTAT_TOKDNE;

  849. 		goto restart;

  850. 	}

  851. 

  852. 

  853. 

  854. 	if (status & USB_ISTAT_USBRST /* 01 */ ) {

  855. 		//serial_print("reset\n");

  856. 

  857. 		// initialize BDT toggle bits

  858. 		USB0_CTL = USB_CTL_ODDRST;

  859. 		ep0_tx_bdt_bank = 0;

  860. 

  861. 		// set up buffers to receive Setup and OUT packets

  862. 		table[index(0, RX, EVEN)].desc = BDT_DESC(EP0_SIZE, 0);

  863. 		table[index(0, RX, EVEN)].addr = ep0_rx0_buf;

  864. 		table[index(0, RX, ODD)].desc = BDT_DESC(EP0_SIZE, 0);

  865. 		table[index(0, RX, ODD)].addr = ep0_rx1_buf;

  866. 		table[index(0, TX, EVEN)].desc = 0;

  867. 		table[index(0, TX, ODD)].desc = 0;

  868. 		

  869. 		// activate endpoint 0

  870. 		USB0_ENDPT0 = USB_ENDPT_EPRXEN | USB_ENDPT_EPTXEN | USB_ENDPT_EPHSHK;

  871. 

  872. 		// clear all ending interrupts

  873. 		USB0_ERRSTAT = 0xFF;

  874. 		USB0_ISTAT = 0xFF;

  875. 

  876. 		// set the address to zero during enumeration

  877. 		USB0_ADDR = 0;

  878. 

  879. 		// enable other interrupts

  880. 		USB0_ERREN = 0xFF;

  881. 		USB0_INTEN = USB_INTEN_TOKDNEEN |

  882. 			USB_INTEN_SOFTOKEN |

  883. 			USB_INTEN_STALLEN |

  884. 			USB_INTEN_ERROREN |

  885. 			USB_INTEN_USBRSTEN |

  886. 			USB_INTEN_SLEEPEN;

  887. 

  888. 		// is this necessary?

  889. 		USB0_CTL = USB_CTL_USBENSOFEN;

  890. 		return;

  891. 	}

  892. 

  893. 

  894. 	if ((status & USB_ISTAT_STALL /* 80 */ )) {

  895. 		//serial_print("stall:\n");

  896. 		USB0_ENDPT0 = USB_ENDPT_EPRXEN | USB_ENDPT_EPTXEN | USB_ENDPT_EPHSHK;

  897. 		USB0_ISTAT = USB_ISTAT_STALL;

  898. 	}

  899. 	if ((status & USB_ISTAT_ERROR /* 02 */ )) {

  900. 		uint8_t err = USB0_ERRSTAT;

  901. 		USB0_ERRSTAT = err;

  902. 		//serial_print("err:");

  903. 		//serial_phex(err);

  904. 		//serial_print("\n");

  905. 		USB0_ISTAT = USB_ISTAT_ERROR;

  906. 	}

  907. 

  908. 	if ((status & USB_ISTAT_SLEEP /* 10 */ )) {

  909. 		//serial_print("sleep\n");

  910. 		USB0_ISTAT = USB_ISTAT_SLEEP;

  911. 	}

  912. 

  913. }

  914. 

  915. 

  916. 

  917. void usb_init(void)

  918. {

  919. 	int i;

  920. 

  921. 	//serial_begin(BAUD2DIV(115200));

  922. 	//serial_print("usb_init\n");

  923. 

  924. 	usb_init_serialnumber();

  925. 

  926. 	for (i=0; i <= NUM_ENDPOINTS*4; i++) {

  927. 		table[i].desc = 0;

  928. 		table[i].addr = 0;

  929. 	}

  930. 

  931. 	// this basically follows the flowchart in the Kinetis

  932. 	// Quick Reference User Guide, Rev. 1, 03/2012, page 141

  933. 

  934. 	// assume 48 MHz clock already running

  935. 	// SIM - enable clock

  936. 	SIM_SCGC4 |= SIM_SCGC4_USBOTG;

  937. 

  938. 	// reset USB module

  939. 	USB0_USBTRC0 = USB_USBTRC_USBRESET;

  940. 	while ((USB0_USBTRC0 & USB_USBTRC_USBRESET) != 0) ; // wait for reset to end

  941. 

  942. 	// set desc table base addr

  943. 	USB0_BDTPAGE1 = ((uint32_t)table) >> 8;

  944. 	USB0_BDTPAGE2 = ((uint32_t)table) >> 16;

  945. 	USB0_BDTPAGE3 = ((uint32_t)table) >> 24;

  946. 

  947. 	// clear all ISR flags

  948. 	USB0_ISTAT = 0xFF;

  949. 	USB0_ERRSTAT = 0xFF;

  950. 	USB0_OTGISTAT = 0xFF;

  951. 

  952. 	USB0_USBTRC0 |= 0x40; // undocumented bit

  953. 

  954. 	// enable USB

  955. 	USB0_CTL = USB_CTL_USBENSOFEN;

  956. 	USB0_USBCTRL = 0;

  957. 

  958. 	// enable reset interrupt

  959. 	USB0_INTEN = USB_INTEN_USBRSTEN;

  960. 

  961. 	// enable interrupt in NVIC...

  962. 	NVIC_SET_PRIORITY(IRQ_USBOTG, 112);

  963. 	NVIC_ENABLE_IRQ(IRQ_USBOTG);

  964. 

  965. 	// enable d+ pullup

  966. 	USB0_CONTROL = USB_CONTROL_DPPULLUPNONOTG;

  967. }

  968. 

  969.