visus
/
teensy-usbhost
Sledovat 1
Oblíbit 0
Rozštěpit 0
Zdrojový kód Úkoly 0 Požadavky na natažení 0 Vydání 0 Wiki Aktivita
Nelze vybrat více než 25 témat Téma musí začínat písmenem nebo číslem, může obsahovat pomlčky („-“) a může být dlouhé až 35 znaků.
233 Revize
1 Větev
Strom: 299257b4ab
Větve Značky
${ item.name }
Vytvořit větev ${ searchTerm }
z „299257b4ab“
${ noResults }
teensy-usbhost/joystick.cpp

999 lines
33KB
Surový Blame Historie 

  1. /* USB EHCI Host for Teensy 3.6

  2.  * Copyright 2017 Paul Stoffregen (paul@pjrc.com)

  3.  *

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

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

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

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

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

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

  10.  * the following conditions:

  11.  *

  12.  * The above copyright notice and this permission notice shall be included

  13.  * in all copies or substantial portions of the Software.

  14.  *

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

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

  17.  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.

  18.  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY

  19.  * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,

  20.  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE

  21.  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.

  22.  */

  23. 

  24. #include <Arduino.h>

  25. #include "USBHost_t36.h"  // Read this header first for key info

  26. 

  27. #define print   USBHost::print_

  28. #define println USBHost::println_

  29. 

  30. #define DEBUG_JOYSTICK

  31. #ifdef  DEBUG_JOYSTICK

  32. #define DBGPrintf USBHDBGSerial.printf

  33. #else

  34. #define DBGPrintf(...) 

  35. #endif

  36. 

  37. // PID/VID to joystick mapping - Only the XBOXOne is used to claim the USB interface directly, 

  38. // The others are used after claim-hid code to know which one we have and to use it for 

  39. // doing other features.  

  40. JoystickController::product_vendor_mapping_t JoystickController::pid_vid_mapping[] = {

  41. 	{ 0x045e, 0x02ea, XBOXONE, false },{ 0x045e, 0x02dd, XBOXONE, false },

  42. 	{ 0x045e, 0x0719, XBOX360, false},

  43. 	{ 0x054C, 0x0268, PS3, true}, 

  44. 	{ 0x054C, 0x05C4, PS4, true}, {0x054C, 0x09CC, PS4, true }

  45. };

  46. 

  47. 

  48. 

  49. //-----------------------------------------------------------------------------

  50. void JoystickController::init()

  51. {

  52. 	contribute_Pipes(mypipes, sizeof(mypipes)/sizeof(Pipe_t));

  53. 	contribute_Transfers(mytransfers, sizeof(mytransfers)/sizeof(Transfer_t));

  54. 	contribute_String_Buffers(mystring_bufs, sizeof(mystring_bufs)/sizeof(strbuf_t));

  55. 	driver_ready_for_device(this);

  56. 	USBHIDParser::driver_ready_for_hid_collection(this);

  57. 	BluetoothController::driver_ready_for_bluetooth(this);

  58. }

  59. 

  60. //-----------------------------------------------------------------------------

  61. JoystickController::joytype_t JoystickController::mapVIDPIDtoJoystickType(uint16_t idVendor, uint16_t idProduct, bool exclude_hid_devices)

  62. {

  63. 	for (uint8_t i = 0; i < (sizeof(pid_vid_mapping)/sizeof(pid_vid_mapping[0])); i++) {

  64. 		if ((idVendor == pid_vid_mapping[i].idVendor) && (idProduct == pid_vid_mapping[i].idProduct)) {

  65. 			println("Match PID/VID: ", i, DEC);

  66. 			if (exclude_hid_devices && pid_vid_mapping[i].hidDevice) return UNKNOWN;

  67. 			return pid_vid_mapping[i].joyType;

  68. 		}

  69. 	}  

  70. 	return UNKNOWN; 	// Not in our list

  71. }

  72. 

  73. //*****************************************************************************

  74. // Some simple query functions depend on which interface we are using...

  75. //*****************************************************************************

  76. 

  77. uint16_t JoystickController::idVendor() 

  78. {

  79. 	if (device != nullptr) return device->idVendor;

  80. 	if (mydevice != nullptr) return mydevice->idVendor;

  81. 	return 0;

  82. }

  83. 

  84. uint16_t JoystickController::idProduct() 

  85. {

  86. 	if (device != nullptr) return device->idProduct;

  87. 	if (mydevice != nullptr) return mydevice->idProduct;

  88. 	return 0;

  89. }

  90. 

  91. const uint8_t *JoystickController::manufacturer()

  92. {

  93. 	if ((device != nullptr) && (device->strbuf != nullptr)) return &device->strbuf->buffer[device->strbuf->iStrings[strbuf_t::STR_ID_MAN]];

  94. 	//if ((btdevice != nullptr) && (btdevice->strbuf != nullptr)) return &btdevice->strbuf->buffer[btdevice->strbuf->iStrings[strbuf_t::STR_ID_MAN]]; 

  95. 	if ((mydevice != nullptr) && (mydevice->strbuf != nullptr)) return &mydevice->strbuf->buffer[mydevice->strbuf->iStrings[strbuf_t::STR_ID_MAN]]; 

  96. 	return nullptr;

  97. }

  98. 

  99. const uint8_t *JoystickController::product()

  100. {

  101. 	if ((device != nullptr) && (device->strbuf != nullptr)) return &device->strbuf->buffer[device->strbuf->iStrings[strbuf_t::STR_ID_PROD]];

  102. 	if ((mydevice != nullptr) && (mydevice->strbuf != nullptr)) return &mydevice->strbuf->buffer[mydevice->strbuf->iStrings[strbuf_t::STR_ID_PROD]]; 

  103. 	if (btdevice != nullptr) return remote_name_;

  104. 	return nullptr;

  105. }

  106. 

  107. const uint8_t *JoystickController::serialNumber()

  108. {

  109. 	if ((device != nullptr) && (device->strbuf != nullptr)) return &device->strbuf->buffer[device->strbuf->iStrings[strbuf_t::STR_ID_SERIAL]];

  110. 	if ((mydevice != nullptr) && (mydevice->strbuf != nullptr)) return &mydevice->strbuf->buffer[mydevice->strbuf->iStrings[strbuf_t::STR_ID_SERIAL]]; 

  111. 	return nullptr;

  112. }

  113. 

  114. 

  115. bool JoystickController::setRumble(uint8_t lValue, uint8_t rValue, uint8_t timeout)

  116. {

  117. 	// Need to know which joystick we are on.  Start off with XBox support - maybe need to add some enum value for the known

  118. 	// joystick types. 

  119. 	rumble_lValue_ = lValue; 

  120. 	rumble_rValue_ = rValue;

  121. 	rumble_timeout_ = timeout;

  122. 

  123. 	switch (joystickType_) {

  124. 		default:

  125. 			break;

  126. 		case PS3:

  127. 			return transmitPS3UserFeedbackMsg();

  128. 		case PS4:

  129. 			return transmitPS4UserFeedbackMsg();

  130. 		case XBOXONE:

  131. 			// Lets try sending a request to the XBox 1.

  132. 			txbuf_[0] = 0x9;

  133. 			txbuf_[1] = 0x0;

  134. 			txbuf_[2] = 0x0;

  135. 			txbuf_[3] = 0x09; // Substructure (what substructure rest of this packet has)

  136. 			txbuf_[4] = 0x00; // Mode

  137. 			txbuf_[5] = 0x0f; // Rumble mask (what motors are activated) (0000 lT rT L R)

  138. 			txbuf_[6] = 0x0; // lT force

  139. 			txbuf_[7] = 0x0; // rT force

  140. 			txbuf_[8] = lValue; // L force

  141. 			txbuf_[9] = rValue; // R force

  142. 			txbuf_[10] = 0xff; // Length of pulse

  143. 			txbuf_[11] = 0x00; // Period between pulses			

  144. 			txbuf_[12] = 0x00; // Repeat			

  145. 			if (!queue_Data_Transfer(txpipe_, txbuf_, 13, this)) {

  146. 				println("XBoxOne rumble transfer fail");

  147. 			}

  148. 			return true;	// 

  149. 		case XBOX360:

  150. 			txbuf_[0] = 0x00;

  151. 			txbuf_[1] = 0x01;

  152. 			txbuf_[2] = 0x0F;

  153. 			txbuf_[3] = 0xC0;

  154. 			txbuf_[4] = 0x00;

  155. 			txbuf_[5] = lValue;

  156. 			txbuf_[6] = rValue;

  157. 			txbuf_[7] = 0x00;

  158. 			txbuf_[8] = 0x00;

  159. 			txbuf_[9] = 0x00;

  160. 			txbuf_[10] = 0x00;

  161. 			txbuf_[11] = 0x00;

  162. 			if (!queue_Data_Transfer(txpipe_, txbuf_, 12, this)) {

  163. 				println("XBox360 rumble transfer fail");

  164. 			}

  165. 			return true;

  166. 	} 

  167. 	return false;

  168. }

  169. 

  170. bool JoystickController::setLEDs(uint8_t lr, uint8_t lg, uint8_t lb)

  171. {

  172. 	// Need to know which joystick we are on.  Start off with XBox support - maybe need to add some enum value for the known

  173. 	// joystick types. 

  174. 	if ((leds_[0] != lr) || (leds_[1] != lg) || (leds_[2] != lb)) {

  175. 		leds_[0] = lr;

  176. 		leds_[1] = lg;

  177. 		leds_[2] = lb;

  178. 

  179. 		switch (joystickType_) {

  180. 			case PS3:

  181. 				return transmitPS3UserFeedbackMsg();

  182. 			case PS4:

  183. 				return transmitPS4UserFeedbackMsg();

  184. 			case XBOX360:

  185. 				// 0: off, 1: all blink then return to before

  186. 				// 2-5(TL, TR, BL, BR) - blink on then stay on

  187. 				// 6-9() - On 

  188. 			    // ...

  189. 				txbuf_[1] = 0x00;

  190. 				txbuf_[2] = 0x08;

  191. 				txbuf_[3] = 0x40 + lr;

  192. 				txbuf_[4] = 0x00;

  193. 				txbuf_[5] = 0x00;

  194. 				txbuf_[6] = 0x00;

  195. 				txbuf_[7] = 0x00;

  196. 				txbuf_[8] = 0x00;

  197. 				txbuf_[9] = 0x00;

  198. 				txbuf_[10] = 0x00;

  199. 				txbuf_[11] = 0x00;

  200. 				if (!queue_Data_Transfer(txpipe_, txbuf_, 12, this)) {

  201. 					println("XBox360 set leds fail");

  202. 				}

  203. 				return true;

  204. 			case XBOXONE:

  205. 			default:

  206. 				return false;

  207. 		} 

  208. 	}

  209. 	return false;

  210. }

  211. 

  212. bool JoystickController::transmitPS4UserFeedbackMsg() {

  213. 	if (driver_)  {

  214. 		uint8_t packet[32];

  215. 	    memset(packet, 0, sizeof(packet));

  216. 

  217. 	    packet[0] = 0x05; // Report ID

  218. 	    packet[1]= 0xFF;

  219. 

  220. 	    packet[4] = rumble_lValue_; // Small Rumble

  221. 	    packet[5] = rumble_rValue_; // Big rumble

  222. 	    packet[6] = leds_[0]; // RGB value 

  223. 	    packet[7] = leds_[1]; 

  224. 	    packet[8] = leds_[2];

  225. 	    // 9, 10 flash ON, OFF times in 100ths of second?  2.5 seconds = 255

  226. 	    DBGPrintf("Joystick update Rumble/LEDs\n");

  227. 		return driver_->sendPacket(packet, 32);

  228. 	} else if (btdriver_) {

  229. 		uint8_t packet[79];

  230. 	    memset(packet, 0, sizeof(packet));

  231. //0xa2, 0x11, 0xc0, 0x20, 0xf0, 0x04, 0x00

  232. 	    packet[0] = 0x52; 

  233. 	    packet[1] = 0x11;      // Report ID

  234. 		packet[2] = 0x80;

  235. 		//packet[3] = 0x20;

  236. 		packet[4] = 0xFF;

  237. 

  238. 	    packet[7] = rumble_lValue_; // Small Rumble

  239. 	    packet[8] = rumble_rValue_; // Big rumble

  240. 	    packet[9] = leds_[0]; // RGB value 

  241. 	    packet[10] = leds_[1]; 

  242. 	    packet[11] = leds_[2];

  243. 

  244. 	    // 12, 13 flash ON, OFF times in 100ths of sedond?  2.5 seconds = 255

  245. 	    DBGPrintf("Joystick update Rumble/LEDs\n");

  246.      	btdriver_->sendL2CapCommand(packet, sizeof(packet), 0x40);

  247. 

  248.      	return true;

  249. 	}

  250. 	return false;

  251. }

  252. 

  253. static const uint8_t PS3_USER_FEEDBACK_INIT[] = {

  254.         0x00, 0x00, 0x00, 0x00, 0x00,

  255.         0x00, 0x00, 0x00, 0x00, 0x00,

  256.         0xff, 0x27, 0x10, 0x00, 0x32,

  257.         0xff, 0x27, 0x10, 0x00, 0x32,

  258.         0xff, 0x27, 0x10, 0x00, 0x32,

  259.         0xff, 0x27, 0x10, 0x00, 0x32,

  260.         0x00, 0x00, 0x00, 0x00, 0x00,

  261.         0x00, 0x00, 0x00, 0x00, 0x00,

  262.         0x00, 0x00, 0x00, 0x00, 0x00,

  263.         0x00, 0x00, 0x00 };

  264. 

  265. bool JoystickController::transmitPS3UserFeedbackMsg() {

  266. 	if (driver_) {

  267. 	    memcpy(txbuf_, PS3_USER_FEEDBACK_INIT, 48);

  268. 

  269. 	    txbuf_[1] = rumble_lValue_? rumble_timeout_ : 0;

  270. 	    txbuf_[2] = rumble_lValue_; // Small Rumble

  271. 	    txbuf_[3] = rumble_rValue_? rumble_timeout_ : 0; 

  272. 	    txbuf_[4] = rumble_rValue_; // Big rumble

  273. 	    txbuf_[9] = leds_[0] << 1; // RGB value 

  274. 	    //DBGPrintf("\nJoystick update Rumble/LEDs %d %d %d %d %d\n",  txbuf_[1], txbuf_[2],  txbuf_[3],  txbuf_[4],  txbuf_[9]);

  275. 		return driver_->sendControlPacket(0x21, 9, 0x201, 0, 48, txbuf_); 

  276. 	} else if (btdriver_) {

  277. 		txbuf_[0] = 0x52;

  278. 		txbuf_[1] = 0x1;

  279. 	    memcpy(&txbuf_[2], PS3_USER_FEEDBACK_INIT, 48);

  280. 

  281. 	    txbuf_[3] = rumble_lValue_? rumble_timeout_ : 0;

  282. 	    txbuf_[4] = rumble_lValue_; // Small Rumble

  283. 	    txbuf_[5] = rumble_rValue_? rumble_timeout_ : 0; 

  284. 	    txbuf_[6] = rumble_rValue_; // Big rumble

  285. 	    txbuf_[11] = leds_[0] << 1; // RGB value 

  286. 	    DBGPrintf("\nJoystick update Rumble/LEDs %d %d %d %d %d\n",  txbuf_[3], txbuf_[4],  txbuf_[5],  txbuf_[6],  txbuf_[11]);

  287.      	btdriver_->sendL2CapCommand(txbuf_, 50, BluetoothController::CONTROL_SCID);

  288.      	return true;

  289. 	}

  290. 	return false;

  291. }

  292. 

  293. //*****************************************************************************

  294. // Support for Joysticks that Use HID data. 

  295. //*****************************************************************************

  296. 

  297. hidclaim_t JoystickController::claim_collection(USBHIDParser *driver, Device_t *dev, uint32_t topusage)

  298. {

  299. 	// only claim Desktop/Joystick and Desktop/Gamepad

  300. 	if (topusage != 0x10004 && topusage != 0x10005) return CLAIM_NO;

  301. 	// only claim from one physical device

  302. 	if (mydevice != NULL && dev != mydevice) return CLAIM_NO;

  303. 

  304. 	// Also don't allow us to claim if it is used as a standard usb object (XBox...)

  305. 	if (device != nullptr) return CLAIM_NO;

  306. 

  307. 	mydevice = dev;

  308. 	collections_claimed++;

  309. 	anychange = true; // always report values on first read

  310. 	driver_ = driver;	// remember the driver. 

  311. 	driver_->setTXBuffers(txbuf_, nullptr, sizeof(txbuf_));

  312. 	connected_ = true;		// remember that hardware is actually connected...

  313. 

  314. 	// Lets see if we know what type of joystick this is. That is, is it a PS3 or PS4 or ...

  315. 	joystickType_ = mapVIDPIDtoJoystickType(mydevice->idVendor, mydevice->idProduct, false);

  316. 	DBGPrintf("JoystickController::claim_collection joystickType_=%d\n", joystickType_);

  317. 	switch (joystickType_) {

  318. 		case PS3:

  319. 			additional_axis_usage_page_ = 0x1;

  320. 			additional_axis_usage_start_ = 0x100;

  321. 			additional_axis_usage_count_ = 39;

  322. 			axis_change_notify_mask_ = (uint64_t)-1;	// Start off assume all bits 

  323. 			break;

  324. 		case PS4:

  325. 			additional_axis_usage_page_ = 0xFF00;

  326. 			additional_axis_usage_start_ = 0x21;

  327. 			additional_axis_usage_count_ = 54;

  328. 			axis_change_notify_mask_ = (uint64_t)0xfffffffffffff3ffl;	// Start off assume all bits - 10 and 11

  329. 			break;

  330. 		default: 

  331. 			additional_axis_usage_page_ = 0;

  332. 			additional_axis_usage_start_ = 0;

  333. 			additional_axis_usage_count_ = 0;

  334. 			axis_change_notify_mask_ = 0x3ff;	// Start off assume only the 10 bits...

  335. 	}

  336. 	DBGPrintf("Claim Additional axis: %x %x %d\n", additional_axis_usage_page_, additional_axis_usage_start_, additional_axis_usage_count_);

  337. 	return CLAIM_REPORT;

  338. }

  339. 

  340. void JoystickController::disconnect_collection(Device_t *dev)

  341. {

  342. 	if (--collections_claimed == 0) {

  343. 		mydevice = NULL;

  344. 		driver_ = nullptr;

  345. 		axis_mask_ = 0;	

  346. 		axis_changed_mask_ = 0;

  347. 	}

  348. }

  349. 

  350. void JoystickController::hid_input_begin(uint32_t topusage, uint32_t type, int lgmin, int lgmax)

  351. {

  352. 	// TODO: set up translation from logical min/max to consistent 16 bit scale

  353. }

  354. 

  355. void JoystickController::hid_input_data(uint32_t usage, int32_t value)

  356. {

  357. 	//DBGPrintf("Joystick: usage=%X, value=%d\n", usage, value);

  358. 	uint32_t usage_page = usage >> 16;

  359. 	usage &= 0xFFFF;

  360. 	if (usage_page == 9 && usage >= 1 && usage <= 32) {

  361. 		uint32_t bit = 1 << (usage -1);

  362. 		if (value == 0) {

  363. 			if (buttons & bit) {

  364. 				buttons &= ~bit;

  365. 				anychange = true;

  366. 			}

  367. 		} else {

  368. 			if (!(buttons & bit)) {

  369. 				buttons |= bit;

  370. 				anychange = true;

  371. 			}

  372. 		}

  373. 	} else if (usage_page == 1 && usage >= 0x30 && usage <= 0x39) {

  374. 		// TODO: need scaling of value to consistent API, 16 bit signed?

  375. 		// TODO: many joysticks repeat slider usage.  Detect & map to axis?

  376. 		uint32_t i = usage - 0x30;

  377. 		axis_mask_ |= (1 << i);		// Keep record of which axis we have data on.

  378. 		if (axis[i] != value) {

  379. 			axis[i] = value;

  380. 			axis_changed_mask_ |= (1 << i);

  381. 			if (axis_changed_mask_ & axis_change_notify_mask_)

  382. 				anychange = true;

  383. 		}

  384. 	} else if (usage_page == additional_axis_usage_page_) {

  385. 		// see if the usage is witin range.

  386. 		//DBGPrintf("UP: usage_page=%x usage=%x User: %x %d\n", usage_page, usage, user_buttons_usage_start, user_buttons_count_);

  387. 		if ((usage >= additional_axis_usage_start_) && (usage < (additional_axis_usage_start_ + additional_axis_usage_count_))) {

  388. 			// We are in the user range. 

  389. 			uint16_t usage_index = usage - additional_axis_usage_start_ + STANDARD_AXIS_COUNT;

  390. 			if (usage_index < (sizeof(axis)/sizeof(axis[0]))) {

  391. 				if (axis[usage_index] != value) {

  392. 					axis[usage_index] = value;

  393. 					if (usage_index > 63) usage_index = 63;	// don't overflow our mask

  394. 					axis_changed_mask_ |= ((uint64_t)1 << usage_index);		// Keep track of which ones changed.

  395. 					if (axis_changed_mask_ & axis_change_notify_mask_)

  396. 						anychange = true;	// We have changes... 

  397. 				}

  398. 				axis_mask_ |= ((uint64_t)1 << usage_index);		// Keep record of which axis we have data on.

  399. 			}

  400. 			//DBGPrintf("UB: index=%x value=%x\n", usage_index, value);

  401. 		}

  402. 

  403. 	} else {

  404. 		DBGPrintf("UP: usage_page=%x usage=%x add: %x %x %d\n", usage_page, usage, additional_axis_usage_page_, additional_axis_usage_start_, additional_axis_usage_count_);

  405. 

  406. 	}

  407. 	// TODO: hat switch?

  408. }

  409. 

  410. void JoystickController::hid_input_end()

  411. {

  412. 	if (anychange) {

  413. 		joystickEvent = true;

  414. 	}

  415. }

  416. 

  417. bool JoystickController::hid_process_out_data(const Transfer_t *transfer) 

  418. {

  419. 	//DBGPrintf("JoystickController::hid_process_out_data\n");

  420. 	return true;

  421. }

  422. 

  423. void JoystickController::joystickDataClear() {

  424. 	joystickEvent = false;

  425. 	anychange = false;

  426. 	axis_changed_mask_ = 0;

  427. 	axis_mask_ = 0;

  428. }

  429. 

  430. //*****************************************************************************

  431. // Support for Joysticks that are class specific and do not use HID

  432. // Example: XBox One controller. 

  433. //*****************************************************************************

  434. 

  435. static  uint8_t xboxone_start_input[] = {0x05, 0x20, 0x00, 0x01, 0x00};

  436. static  uint8_t xbox360w_inquire_present[] = {0x08, 0x00, 0x0F, 0xC0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};

  437. 

  438. bool JoystickController::claim(Device_t *dev, int type, const uint8_t *descriptors, uint32_t len)

  439. {

  440. 	println("JoystickController claim this=", (uint32_t)this, HEX);

  441. 

  442. 	// Don't try to claim if it is used as USB device or HID device

  443. 	if (mydevice != NULL) return false;

  444. 	if (device != nullptr) return false;

  445. 

  446. 	// Try claiming at the interface level.

  447. 	if (type != 1) return false;

  448. 	print_hexbytes(descriptors, len);

  449. 

  450. 	JoystickController::joytype_t jtype = mapVIDPIDtoJoystickType(dev->idVendor, dev->idProduct, true);

  451. 	println("Jtype=", (uint8_t)jtype, DEC);

  452. 	if (jtype == UNKNOWN)

  453. 		return false; 

  454. 

  455. 	// XBOX One

  456. 	//  0  1  2  3  4  5  6  7  8 *9 10  1  2  3  4  5 *6  7  8  9 20  1  2  3  4  5  6  7  8  9 30  1... 

  457. 	// 09 04 00 00 02 FF 47 D0 00 07 05 02 03 40 00 04 07 05 82 03 40 00 04 09 04 01 00 00 FF 47 D0 00 

  458. 	// Lets do some verifications to make sure. 

  459. 

  460. 	// XBOX 360 wireless... Has 8 interfaces.  4 joysticks (1, 3, 5, 7) and 4 headphones assume 2,4,6, 8... 

  461. 	// Shows data for #1 only... 

  462. 	// Also they have some unknown data type we need to ignore between interface and end points.

  463. 	//  0  1  2  3  4  5  6  7  8 *9 10  1  2  3  4  5 *6  7  8  9 20  1  2  3  4  5  6  7  8 

  464. 	// 09 04 00 00 02 FF 5D 81 00 14 22 00 01 13 81 1D 00 17 01 02 08 13 01 0C 00 0C 01 02 08 

  465. 

  466.   	// 29 30  1  2  3  4  5  6  7  8  9 40 41 42

  467. 	// 07 05 81 03 20 00 01 07 05 01 03 20 00 08 

  468. 

  469. 	if (len < 9+7+7) return false;

  470. 

  471. 	// Some common stuff for both XBoxs

  472. 	uint32_t count_end_points = descriptors[4];

  473. 	if (count_end_points < 2) return false;

  474. 	if (descriptors[5] != 0xff) return false; // bInterfaceClass, 3 = HID

  475. 	rx_ep_ = 0;

  476. 	uint32_t txep = 0;

  477. 	uint8_t rx_interval = 0;

  478. 	uint8_t tx_interval = 0;

  479. 	rx_size_ = 0;

  480. 	tx_size_ = 0;

  481. 	uint32_t descriptor_index = 9; 

  482. 	if (descriptors[descriptor_index+1] == 0x22)  {

  483. 		if (descriptors[descriptor_index] != 0x14) return false; // only support specific versions...

  484. 		descriptor_index += descriptors[descriptor_index]; // XBox360w ignore this unknown setup...

  485. 	}	

  486. 	while (count_end_points-- && ((rx_ep_ == 0) || txep == 0)) {

  487. 		if (descriptors[descriptor_index] != 7) return false; // length 7

  488. 		if (descriptors[descriptor_index+1] != 5) return false; // ep desc

  489. 		if ((descriptors[descriptor_index+3] == 3) 				// Type 3...

  490. 			&& (descriptors[descriptor_index+4] <= 64)

  491. 			&& (descriptors[descriptor_index+5] == 0)) {

  492. 			// have a bulk EP size 

  493. 			if (descriptors[descriptor_index+2] & 0x80 ) {

  494. 				rx_ep_ = descriptors[descriptor_index+2];

  495. 				rx_size_ = descriptors[descriptor_index+4];

  496. 				rx_interval = descriptors[descriptor_index+6];

  497. 			} else {

  498. 				txep = descriptors[descriptor_index+2]; 

  499. 				tx_size_ = descriptors[descriptor_index+4];

  500. 				tx_interval = descriptors[descriptor_index+6];

  501. 			}

  502. 		}

  503. 		descriptor_index += 7;  // setup to look at next one...

  504. 	}

  505. 	if ((rx_ep_ == 0) || (txep == 0)) return false; // did not find two end points.

  506. 	print("JoystickController, rx_ep_=", rx_ep_ & 15);

  507. 	print("(", rx_size_);

  508. 	print("), txep=", txep);

  509. 	print("(", tx_size_);

  510. 	println(")");

  511. 	rxpipe_ = new_Pipe(dev, 3, rx_ep_ & 15, 1, rx_size_, rx_interval);

  512. 	if (!rxpipe_) return false;

  513. 	txpipe_ = new_Pipe(dev, 3, txep, 0, tx_size_, tx_interval);

  514. 	if (!txpipe_) {

  515. 		//free_Pipe(rxpipe_);

  516. 		return false;

  517. 	}

  518. 	rxpipe_->callback_function = rx_callback;

  519. 	queue_Data_Transfer(rxpipe_, rxbuf_, rx_size_, this);

  520. 

  521. 	txpipe_->callback_function = tx_callback;

  522. 

  523. 	if (jtype == XBOXONE) {

  524. 		queue_Data_Transfer(txpipe_, xboxone_start_input, sizeof(xboxone_start_input), this);

  525. 		connected_ = true;		// remember that hardware is actually connected...

  526. 	} else if (jtype == XBOX360) {

  527. 		queue_Data_Transfer(txpipe_, xbox360w_inquire_present, sizeof(xbox360w_inquire_present), this);

  528. 		connected_ = 0;		// remember that hardware is actually connected...

  529. 	}

  530. 	memset(axis, 0, sizeof(axis));	// clear out any data. 

  531. 	joystickType_ = jtype;		// remember we are an XBox One. 

  532. 	DBGPrintf("   JoystickController::claim joystickType_ %d\n", joystickType_);

  533. 	return true;

  534. }

  535. 

  536. void JoystickController::control(const Transfer_t *transfer)

  537. {

  538. }

  539. 

  540. 

  541. /************************************************************/

  542. //  Interrupt-based Data Movement

  543. /************************************************************/

  544. 

  545. void JoystickController::rx_callback(const Transfer_t *transfer)

  546. {

  547. 	if (!transfer->driver) return;

  548. 	((JoystickController *)(transfer->driver))->rx_data(transfer);

  549. }

  550. 

  551. void JoystickController::tx_callback(const Transfer_t *transfer)

  552. {

  553. 	if (!transfer->driver) return;

  554. 	((JoystickController *)(transfer->driver))->tx_data(transfer);

  555. }

  556. 

  557. 

  558. 

  559. /************************************************************/

  560. //  Interrupt-based Data Movement

  561. // XBox one input data when type == 0x20

  562. // Information came from several places on the web including: 

  563. // https://github.com/quantus/xbox-one-controller-protocol

  564. /************************************************************/

  565. // 20 00 C5 0E 00 00 00 00 00 00 F0 06 AD FB 7A 0A DD F7 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00

  566. // 20 00 E0 0E 40 00 00 00 00 00 F0 06 AD FB 7A 0A DD F7 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00

  567. typedef struct {

  568. 	uint8_t type;

  569. 	uint8_t const_0;

  570. 	uint16_t id;

  571. 	// From online references button order: 

  572. 	//     sync, dummy, start, back, a, b, x, y

  573. 	//     dpad up, down left, right

  574. 	//	   lb, rb, left stick, right stick

  575. 	// Axis: 

  576. 	//     lt, rt, lx, ly, rx, ry

  577. 	//     

  578. 	uint16_t buttons; 

  579. 	int16_t	axis[6];

  580. } xbox1data20_t;

  581. 

  582. typedef struct {

  583. 	uint8_t state;

  584. 	uint8_t id_or_type;

  585. 	uint16_t controller_status;

  586. 	uint16_t unknown;

  587. 	// From online references button order: 

  588. 	//     sync, dummy, start, back, a, b, x, y

  589. 	//     dpad up, down left, right

  590. 	//	   lb, rb, left stick, right stick

  591. 	// Axis: 

  592. 	//     lt, rt, lx, ly, rx, ry

  593. 	//

  594. 	uint16_t buttons; 

  595. 	uint8_t lt;

  596. 	uint8_t rt;

  597. 	int16_t	axis[4];

  598. } xbox360data_t;

  599. 

  600. static const uint8_t xbox_axis_order_mapping[] = {3, 4, 0, 1, 2, 5};

  601. 

  602. void JoystickController::rx_data(const Transfer_t *transfer)

  603. {

  604. 	print("JoystickController::rx_data (", joystickType_, DEC);

  605. 	print("): ");

  606. 	print_hexbytes((uint8_t*)transfer->buffer, transfer->length);

  607. 

  608. 	if (joystickType_ == XBOXONE) {

  609. 		// Process XBOX One data

  610. 		axis_mask_ = 0x3f;	

  611. 		axis_changed_mask_ = 0;	// assume none for now

  612. 		xbox1data20_t *xb1d = (xbox1data20_t *)transfer->buffer;

  613. 		if ((xb1d->type == 0x20) && (transfer->length >= sizeof (xbox1data20_t))) {

  614. 			// We have a data transfer.  Lets see what is new...

  615. 			if (xb1d->buttons != buttons) {

  616. 				buttons = xb1d->buttons;

  617. 				anychange = true;

  618. 				joystickEvent = true;

  619. 				println("  Button Change: ", buttons, HEX);

  620. 			}

  621. 			for (uint8_t i = 0; i < sizeof (xbox_axis_order_mapping); i++) {

  622. 				// The first two values were unsigned. 

  623. 				int axis_value = (i < 2)? (int)(uint16_t)xb1d->axis[i] : xb1d->axis[i];

  624. 				if (axis_value != axis[xbox_axis_order_mapping[i]]) {

  625. 					axis[xbox_axis_order_mapping[i]] = axis_value;

  626. 					axis_changed_mask_ |= (1 << xbox_axis_order_mapping[i]);

  627. 					anychange = true;

  628. 				}

  629. 			}

  630. 			joystickEvent = true;

  631. 		}

  632. 

  633. 	} else if (joystickType_ == XBOX360) {

  634. 		// First byte appears to status - if the byte is 0x8 it is a connect or disconnect of the controller. 

  635. 		xbox360data_t  *xb360d = (xbox360data_t *)transfer->buffer;

  636. 		if (xb360d->state == 0x08) {

  637. 			if (xb360d->id_or_type != connected_) {

  638. 				connected_ = xb360d->id_or_type;	// remember it... 

  639. 				if (connected_) {

  640. 					println("XBox360w - Connected type:", connected_, HEX);

  641. 					// rx_ep_ should be 1, 3, 5, 7 for the wireless convert to 2-5 on led

  642. 					setLEDs(2+rx_ep_/2);	// Right now hard coded to first joystick...

  643. 

  644. 				} else {

  645. 					println("XBox360w - disconnected");

  646. 				}

  647. 			}

  648. 		} else if((xb360d->id_or_type == 0x00) && (xb360d->controller_status & 0x1300)) {

  649. 			  // Controller status report - Maybe we should save away and allow the user access?

  650. 	            println("XBox360w - controllerStatus: ", xb360d->controller_status, HEX);

  651.         } else if(xb360d->id_or_type == 0x01) { // Lets only process report 1.

  652. 			//const uint8_t *pbuffer = (uint8_t*)transfer->buffer;

  653.         	//for (uint8_t i = 0; i < transfer->length; i++) DBGPrintf("%02x ", pbuffer[i]);

  654.         	//DBGPrintf("\n");

  655. 	        

  656. 	        if (buttons != xb360d->buttons) {

  657. 	        	buttons = xb360d->buttons;

  658. 	        	anychange = true;

  659. 	        }

  660. 			axis_mask_ = 0x3f;	

  661. 			axis_changed_mask_ = 0;	// assume none for now

  662. 

  663. 			for (uint8_t i = 0; i < 4; i++) {

  664. 				if (axis[i] != xb360d->axis[i]) {

  665. 					axis[i] = xb360d->axis[i];

  666. 					axis_changed_mask_ |= (1 << i);

  667. 					anychange = true;

  668. 				}

  669. 			}

  670. 			// the two triggers show up as 4 and 5

  671. 			if (axis[4] != xb360d->lt) {

  672. 				axis[4] = xb360d->lt;

  673. 				axis_changed_mask_ |= (1 << 4);

  674. 				anychange = true;

  675. 			}

  676. 

  677. 			if (axis[5] != xb360d->rt) {

  678. 				axis[5] = xb360d->rt;

  679. 				axis_changed_mask_ |= (1 << 5);

  680. 				anychange = true;

  681. 			}

  682. 

  683. 			if (anychange) joystickEvent = true;

  684. 		}

  685. 	}

  686. 

  687. 	queue_Data_Transfer(rxpipe_, rxbuf_, rx_size_, this);

  688. }

  689. 

  690. void JoystickController::tx_data(const Transfer_t *transfer)

  691. {

  692. }

  693. 

  694. void JoystickController::disconnect()

  695. {

  696. 	axis_mask_ = 0;	

  697. 	axis_changed_mask_ = 0;

  698. 	// TODO: free resources

  699. }

  700. 

  701. bool JoystickController::claim_bluetooth(BluetoothController *driver, uint32_t bluetooth_class, uint8_t *remoteName) 

  702. {

  703. 	if ((((bluetooth_class & 0xff00) == 0x2500) || (((bluetooth_class & 0xff00) == 0x500))) && ((bluetooth_class & 0x3C) == 0x08)) {

  704. 		DBGPrintf("JoystickController::claim_bluetooth TRUE\n");

  705. 		btdriver_ = driver;

  706. 		btdevice = (Device_t*)driver;	// remember this way 

  707. 		if (remoteName) mapNameToJoystickType(remoteName);

  708. 		return true;

  709. 	}

  710. 

  711. 	if (remoteName && mapNameToJoystickType(remoteName)) {

  712. 		if (joystickType_ == PS3) {

  713. 			DBGPrintf("JoystickController::claim_bluetooth TRUE PS3 hack...\n");

  714. 			btdriver_ = driver;

  715. 			btdevice = (Device_t*)driver;	// remember this way 

  716. 			special_process_required = SP_PS3_IDS; 		// PS3 maybe needs different IDS. 

  717. 			return true;

  718. 		}

  719. 	}

  720. 	return false;

  721. }

  722. 

  723. 

  724. bool JoystickController::process_bluetooth_HID_data(const uint8_t *data, uint16_t length) 

  725. {

  726. 	// Example data from PS4 controller

  727. 	//01 7e 7f 82 84 08 00 00 00 00

  728. 	//   LX LY RX RY BT BT PS LT RT

  729. 	//DBGPrintf("JoystickController::process_bluetooth_HID_data\n");

  730. 	// May have to look at this one with other controllers...

  731. 	if (data[0] == 1) {

  732. 		//print("  Joystick Data: ");

  733. 		//print_hexbytes(data, length);

  734. //		DBGPrintf("  Joystick Data: ");

  735. 		if (length > TOTAL_AXIS_COUNT) length = TOTAL_AXIS_COUNT;	// don't overflow arrays...

  736. 		if (joystickType_ == PS3) {

  737. 			// Quick and dirty hack to match PS3 HID data

  738. 			uint32_t cur_buttons = data[2] | ((uint16_t)data[3] << 8) | ((uint32_t)data[4] << 16); 

  739. 			if (cur_buttons != buttons) {

  740. 				buttons = cur_buttons;

  741. 				joystickEvent = true;	// something changed.

  742. 			}

  743. 

  744. 			uint64_t mask = 0x1;

  745. 			axis_mask_ = 0x27;	// assume bits 0, 1, 2, 5

  746. 			for (uint16_t i = 0; i < 3; i++) {

  747. 				if (axis[i] != data[i+6]) {

  748. 					axis_changed_mask_ |= mask;

  749. 					axis[i] = data[i+6];

  750. 				}

  751. 				mask <<= 1;	// shift down the mask.

  752. 			}

  753. 			if (axis[5] != data[9]) {

  754. 				axis_changed_mask_ |= (1<<5);

  755. 				axis[5] = data[9];

  756. 			}

  757. 			

  758. 			if (axis[3] != data[18]) {

  759. 				axis_changed_mask_ |= (1<<3);

  760. 				axis[3] = data[18];

  761. 			}

  762. 			

  763. 			if (axis[4] != data[19]) {

  764. 				axis_changed_mask_ |= (1<<4);

  765. 				axis[4] = data[19];

  766. 			}

  767. 			

  768. 			// Then rest of data

  769. 			mask = 0x1 << 10;	// setup for other bits

  770. 			for (uint16_t i = 10; i < length; i++ ) {

  771. 				axis_mask_ |= mask;

  772. 				if(data[i] != axis[i]) { 

  773. 					axis_changed_mask_ |= mask;

  774. 					axis[i] = data[i];

  775. 				} 

  776. 				mask <<= 1;	// shift down the mask.

  777. 			}

  778. 

  779. 		} else {

  780. 			uint64_t mask = 0x1;

  781. 			axis_mask_ = 0;

  782. 

  783. 			for (uint16_t i = 0; i < length; i++ ) {

  784. 				axis_mask_ |= mask;

  785. 				if(data[i] != axis[i]) { 

  786. 					axis_changed_mask_ |= mask;

  787. 					axis[i] = data[i];

  788. 				} 

  789. 				mask <<= 1;	// shift down the mask.

  790. //				DBGPrintf("%02x ", axis[i]);

  791. 			}

  792. 

  793. 		}

  794. 

  795. 		if (axis_changed_mask_ & axis_change_notify_mask_)

  796. 			joystickEvent = true;

  797. 		connected_ = true;

  798. 		return true;

  799. 

  800. 	} else if(data[0] == 0x11){

  801. 		if (data[0] == 1) {

  802. 			//print("  Joystick Data: ");

  803. 			//print_hexbytes(data, length);

  804. 	//		DBGPrintf("  Joystick Data: ");

  805. 			uint64_t mask = 0x1;

  806. 			axis_mask_ = 0;

  807. 			axis_changed_mask_ = 0;

  808. 

  809. 			if (length > TOTAL_AXIS_COUNT) length = TOTAL_AXIS_COUNT;	// don't overflow arrays...

  810. 			for (uint16_t i = 0; i < length; i++ ) {

  811. 				axis_mask_ |= mask;

  812. 				if(data[i] != axis[i]) { 

  813. 					axis_changed_mask_ |= mask;

  814. 					axis[i] = data[i];

  815. 				} 

  816. 				mask <<= 1;	// shift down the mask.

  817. 	//			DBGPrintf("%02x ", axis[i]);

  818. 			}

  819. 	//		DBGPrintf("\n");

  820. 			joystickEvent = true;

  821. 			connected_ = true;

  822. 			return true;

  823. 		} else if(data[0] == 0x11){

  824. 			DBGPrintf("\n  Joystick Data: ");

  825. 			uint64_t mask = 0x1;

  826. 			axis_mask_ = 0;

  827. 			axis_changed_mask_ = 0;

  828. 			

  829. 			//This moves data to be equivalent to what we see for

  830. 			//data[0] = 0x01

  831. 			uint8_t tmp_data[length-2];

  832. 			

  833. 			for (uint16_t i = 0; i < (length-2); i++ ) {

  834. 				tmp_data[i] = 0;

  835. 				tmp_data[i] = data[i+2];

  836. 			}

  837. 			

  838. 			/*

  839. 			 * [1] LX, [2] = LY, [3] = RX, [4] = RY

  840. 			 * [5] combo, tri, cir, x, sqr, D-PAD (4bits, 0-3

  841. 			 * [6] R3,L3, opt, share, R2, L2, R1, L1

  842. 			 * [7] Counter (bit7-2), T-PAD, PS

  843. 			 * [8] Left Trigger, [9] Right Trigger

  844. 			 * [10-11] Timestamp

  845. 			 * [12] Battery (0 to 0xff)

  846. 			 * [13-14] acceleration x

  847. 			 * [15-16] acceleration y

  848. 			 * [17-18] acceleration z

  849. 			 * [19-20] gyro x

  850. 			 * [21-22] gyro y

  851. 			 * [23-24] gyro z

  852. 			 * [25-29] unknown

  853. 			 * [30] 0x00,phone,mic, usb, battery level (4bits)

  854. 			 * rest is trackpad?  to do implement?

  855. 			 */

  856. 			//PS Bit

  857. 			tmp_data[7] = (tmp_data[7] >> 0) & 1;

  858. 			//set arrow buttons to axis[0]

  859. 			tmp_data[10] = tmp_data[5] & ((1 << 4) - 1);

  860. 			//set buttons for last 4bits in the axis[5]

  861. 			tmp_data[5] = tmp_data[5] >> 4;

  862. 			

  863. 		

  864. 			// Quick and dirty hack to match PS4 HID data

  865. 			uint32_t cur_buttons = tmp_data[7] | (tmp_data[10]) | ((tmp_data[6]*10)) | ((uint16_t)tmp_data[5] << 16) ; 

  866. 			if (cur_buttons != buttons) {

  867. 				buttons = cur_buttons;

  868. 				joystickEvent = true;	// something changed.

  869. 			}

  870. 			

  871. 			mask = 0x1;

  872. 			axis_mask_ = 0x27;	// assume bits 0, 1, 2, 5

  873. 			for (uint16_t i = 0; i < 3; i++) {

  874. 				if (axis[i] != tmp_data[i+1]) {

  875. 					axis_changed_mask_ |= mask;

  876. 					axis[i] = tmp_data[i+1];

  877. 				}

  878. 				mask <<= 1;	// shift down the mask.

  879. 			}

  880. 			if (axis[5] != tmp_data[4]) {

  881. 				axis_changed_mask_ |= (1<<5);

  882. 				axis[5] = tmp_data[4];

  883. 			}

  884. 			

  885. 			if (axis[3] != tmp_data[8]) {

  886. 				axis_changed_mask_ |= (1<<3);

  887. 				axis[3] = tmp_data[8];

  888. 			}

  889. 			

  890. 			if (axis[4] != tmp_data[9]) {

  891. 				axis_changed_mask_ |= (1<<4);

  892. 				axis[4] = tmp_data[9];

  893. 			}

  894. 			

  895. 			//limit for masking

  896. 			mask = 0x1;

  897. 			for (uint16_t i = 6; i < (64); i++ ) {

  898. 				axis_mask_ |= mask;

  899. 				if(tmp_data[i] != axis[i]) { 

  900. 					axis_changed_mask_ |= mask;

  901. 					axis[i] = tmp_data[i];

  902. 				}

  903. 				mask <<= 1;	// shift down the mask.

  904. 				DBGPrintf("%02x ", axis[i]);

  905. 			}

  906. 			DBGPrintf("\n");

  907. 			//DBGPrintf("Axis Mask (axis_mask_, axis_changed_mask_; %d, %d\n", axis_mask_,axis_changed_mask_);

  908. 			joystickEvent = true;

  909. 			connected_ = true;

  910. 		}

  911. 	}

  912. 	return false;

  913. }

  914. 

  915. bool JoystickController::mapNameToJoystickType(const uint8_t *remoteName)

  916. {

  917. 	// Sort of a hack, but try to map the name given from remote to a type...

  918. 	if (strncmp((const char *)remoteName, "Wireless Controller", 19) == 0) {

  919. 		DBGPrintf("  JoystickController::mapNameToJoystickType %s - set to PS4\n", remoteName);

  920. 		joystickType_ = PS4;

  921. 	} else if (strncmp((const char *)remoteName, "PLAYSTATION(R)3", 15) == 0) {

  922. 		DBGPrintf("  JoystickController::mapNameToJoystickType %x %s - set to PS3\n", (uint32_t)this, remoteName);

  923. 		joystickType_ = PS3;

  924. 	} else if (strncmp((const char *)remoteName, "Xbox Wireless", 13) == 0) {

  925. 		DBGPrintf("  JoystickController::mapNameToJoystickType %x %s - set to XBOXONE\n", (uint32_t)this, remoteName);

  926. 		joystickType_ = XBOXONE;

  927. 	} else {

  928. 		DBGPrintf("  JoystickController::mapNameToJoystickType %s - Unknown\n", remoteName);

  929. 	}

  930. 	DBGPrintf("  Joystick Type: %d\n", joystickType_);

  931. 	return true;

  932. }

  933. 

  934. 

  935. bool JoystickController::remoteNameComplete(const uint8_t *remoteName) 

  936. {

  937. 	// Sort of a hack, but try to map the name given from remote to a type...

  938. 	if (mapNameToJoystickType(remoteName)) {

  939. 		switch (joystickType_) {

  940. 			case PS4: special_process_required = SP_NEED_CONNECT; break;

  941. 			case PS3: special_process_required = SP_PS3_IDS; break;

  942. 			default: 

  943. 				break;

  944. 		}

  945. 	}

  946. 	return true;

  947. }

  948. 

  949. void JoystickController::connectionComplete() 

  950. {

  951. 	DBGPrintf("  JoystickController::connectionComplete %x joystick type %d\n", (uint32_t)this, joystickType_);

  952. 	if (joystickType_ == PS4) {

  953. 		uint8_t packet[2];

  954. 		packet[0] = 0x43; // HID BT Get_report (0x40) | Report Type (Feature 0x03)

  955. 		packet[1] = 0x02; // Report ID

  956. 		DBGPrintf("Set PS4 report\n");

  957. 		delay(1);

  958. 		btdriver_->sendL2CapCommand(packet, sizeof(packet), 0x40);

  959. 

  960. 	} else if (joystickType_ == PS3) {

  961. 	uint8_t packet[6];

  962. 		packet[0] = 0x53; // HID BT Set_report (0x50) | Report Type (Feature 0x03)

  963. 		packet[1] = 0xF4; // Report ID

  964. 		packet[2] = 0x42; // Special PS3 Controller enable commands

  965. 		packet[3] = 0x03;

  966. 		packet[4] = 0x00;

  967. 		packet[5] = 0x00;

  968. 

  969. 		DBGPrintf("enable six axis\n");

  970. 		delay(1);

  971. 		btdriver_->sendL2CapCommand(packet, sizeof(packet), BluetoothController::CONTROL_SCID);

  972. 	}

  973. 

  974. }

  975. 

  976. void JoystickController::release_bluetooth() 

  977. {

  978. 	btdevice = nullptr;	// remember this way 

  979. 	btdriver_ = nullptr;

  980. 	connected_ = false;

  981. 	special_process_required = false;

  982. 

  983. }

  984. 

  985. 

  986. bool JoystickController::PS3Pair(uint8_t* bdaddr) {

  987.  	if ((joystickType_ != PS3) || !driver_) return false; // not a PS2 nor plugged into USB...

  988. 

  989.     /* Set the internal Bluetooth address */

  990.     txbuf_[0] = 0x01;

  991.     txbuf_[1] = 0x00;

  992. 

  993.     for(uint8_t i = 0; i < 6; i++)

  994.             txbuf_[i + 2] = bdaddr[5 - i]; // Copy into buffer, has to be written reversed, so it is MSB first

  995. 

  996.     // bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0xF5), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data

  997. 	return driver_->sendControlPacket(0x21, 9, 0x3f5, 0, 8, txbuf_); 

  998. }