forked from noble/noble
-
-
Notifications
You must be signed in to change notification settings - Fork 1
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
feat: added setAddress function to change mac address
- Loading branch information
1 parent
7e645ab
commit 286a8e5
Showing
6 changed files
with
254 additions
and
24 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,152 @@ | ||
| // This file is based on the bluez implementation | ||
| // https://github.com/bluez/bluez/blob/master/tools/bdaddr.c | ||
|
|
||
| const OGF_VENDOR_CMD = 0x3f; | ||
|
|
||
| const OCF_ERICSSON_WRITE_BD_ADDR = 0x000d; | ||
| const OCF_TI_WRITE_BD_ADDR = 0x0006; | ||
| const OCF_LINUX_FOUNDATION_WRITE_BD_ADDR = 0x0006; | ||
| const OCF_BCM_WRITE_BD_ADDR = 0x0001; | ||
| const OCF_ZEEVO_WRITE_BD_ADDR = 0x0001; | ||
| const OCF_MRVL_WRITE_BD_ADDR = 0x0022; | ||
| const OCF_ERICSSON_STORE_IN_FLASH = 0x0022; | ||
| const ERICSSON_STORE_IN_FLASH_CP_SIZE = 0xFF; | ||
|
|
||
| function parseAddress(address) { | ||
| // Parse MAC Address as in 00:00:00:00:00:00 into Buffer (needs to reverse byte order) | ||
| let macAddress = Buffer.from(address.split(':').reverse().join(''), 'hex'); | ||
|
|
||
| if (Buffer.isBuffer(macAddress) && macAddress.byteLength !== 6) { | ||
| throw new Error("Invalid MAC Address. Should be formated as 00:00:00:00:00:00 string."); | ||
| } | ||
|
|
||
| return macAddress; | ||
| } | ||
|
|
||
| function csr_write_bd_addr(address) { | ||
| // Parse MAC Address | ||
| const macAddress = parseAddress(address); | ||
|
|
||
| if (macAddress === null) { | ||
| return null; | ||
| } | ||
|
|
||
| // Base command | ||
| const base = Buffer.from([ | ||
| 0x02, 0x00, 0x0c, 0x00, 0x11, 0x47, 0x03, 0x70, | ||
| 0x00, 0x00, 0x01, 0x00, 0x04, 0x00, 0x00, 0x00, | ||
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 | ||
| ]); | ||
|
|
||
| // Command | ||
| const cmd = Buffer.alloc(3 + base.byteLength); | ||
|
|
||
| cmd.writeUInt16LE(0x00 | OGF_VENDOR_CMD << 10, 0); | ||
| cmd.writeUInt8(0xC2, 2); | ||
|
|
||
| base.writeUint8(macAddress.readUInt8(2), 16); | ||
| base.writeUint8(0x00, 17); | ||
| base.writeUint8(macAddress.readUInt8(0), 18); | ||
| base.writeUint8(macAddress.readUInt8(1), 19); | ||
| base.writeUint8(macAddress.readUInt8(3), 20); | ||
| base.writeUint8(0x00, 21); | ||
| base.writeUint8(macAddress.readUInt8(4), 22); | ||
| base.writeUint8(macAddress.readUInt8(5), 23); | ||
| base.copy(cmd, 3); | ||
|
|
||
| return cmd; | ||
| } | ||
|
|
||
| function ericsson_store_in_flash(user_id, data) { | ||
| // Check Data | ||
| if (Buffer.isBuffer(data) === false || data.byteLength > OCF_ERICSSON_STORE_IN_FLASH - 2) { | ||
| return null; | ||
| } | ||
|
|
||
| // Command | ||
| const cmd = Buffer.alloc(3 + ERICSSON_STORE_IN_FLASH_CP_SIZE); | ||
|
|
||
| cmd.writeUInt16LE(OCF_ERICSSON_STORE_IN_FLASH | OGF_VENDOR_CMD << 10, 0); | ||
| cmd.writeUInt8(ERICSSON_STORE_IN_FLASH_CP_SIZE, 2); | ||
| cmd.writeUInt8(user_id, 3); // user_id | ||
| cmd.writeUInt8(data.byteLength, 4); // flash_length | ||
| data.copy(cmd, 5); // flash_data | ||
|
|
||
| return cmd; | ||
| } | ||
|
|
||
| function st_write_bd_addr(address) { | ||
| // Parse MAC Address | ||
| const macAddress = parseAddress(address); | ||
|
|
||
| if (macAddress === null) { | ||
| return null; | ||
| } | ||
|
|
||
| return ericsson_store_in_flash(0xFE, macAddress); | ||
| } | ||
|
|
||
| function mrvl_write_bd_addr(address) { | ||
| // Parse MAC Address | ||
| const macAddress = parseAddress(address); | ||
|
|
||
| if (macAddress === null) { | ||
| return null; | ||
| } | ||
|
|
||
| // Command | ||
| const cmd = Buffer.alloc(11); | ||
|
|
||
| cmd.writeUInt16LE(OCF_MRVL_WRITE_BD_ADDR | OGF_VENDOR_CMD << 10, 0); | ||
| cmd.writeUInt8(0x08, 2); | ||
| cmd.writeUInt8(0xFE, 3); // parameter_id | ||
| cmd.writeUInt8(0x06, 4); // bdaddr_len | ||
| macAddress.copy(cmd, 5); // bdaddr | ||
|
|
||
| return cmd; | ||
| } | ||
|
|
||
| function write_common_bd_addr(OCF_VS_WRITE_BD_ADDR) { | ||
| // Return a function | ||
| return (address) => { | ||
|
|
||
| // Parse MAC Address | ||
| const macAddress = parseAddress(address); | ||
|
|
||
| if (macAddress === null) { | ||
| return null; | ||
| } | ||
|
|
||
| // Command | ||
| const cmd = Buffer.alloc(9); | ||
|
|
||
| cmd.writeUInt16LE(OCF_VS_WRITE_BD_ADDR | OGF_VENDOR_CMD << 10, 0); | ||
| cmd.writeUInt8(0x06, 2); | ||
| macAddress.copy(cmd, 3); // bdaddr | ||
|
|
||
| return cmd; | ||
| } | ||
| } | ||
|
|
||
| const vendors = new Map(); | ||
|
|
||
| vendors.set(0, write_common_bd_addr(OCF_ERICSSON_WRITE_BD_ADDR)); | ||
| vendors.set(10, csr_write_bd_addr); | ||
| vendors.set(13, write_common_bd_addr(OCF_TI_WRITE_BD_ADDR)); | ||
| vendors.set(15, write_common_bd_addr(OCF_BCM_WRITE_BD_ADDR)); | ||
| vendors.set(18, write_common_bd_addr(OCF_ZEEVO_WRITE_BD_ADDR)); | ||
| vendors.set(48, st_write_bd_addr); | ||
| vendors.set(57, write_common_bd_addr(OCF_ERICSSON_WRITE_BD_ADDR)); | ||
| vendors.set(72, mrvl_write_bd_addr); | ||
| vendors.set(1521, write_common_bd_addr(OCF_LINUX_FOUNDATION_WRITE_BD_ADDR)); | ||
|
|
||
| module.exports = { | ||
| // Vendor Specific Set Address | ||
| setAddressCmd: (manufacturer, address) => { | ||
| const generateCommand = vendors.get(manufacturer); | ||
| if (typeof generateCommand === 'function' ) { | ||
| return generateCommand(address) || null; | ||
| } | ||
| return null; | ||
| } | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,26 @@ | ||
| const should = require('should'); | ||
| const sinon = require('sinon'); | ||
| const proxyquire = require('proxyquire').noCallThru(); | ||
|
|
||
| const fakeOs = {}; | ||
| const { assert } = sinon; | ||
| const vendorSpecific = proxyquire('../../../lib/hci-socket/vs', { os: fakeOs }); | ||
|
|
||
| describe('hci-socket vs', () => { | ||
|
|
||
| afterEach(() => { | ||
| sinon.reset(); | ||
| }); | ||
|
|
||
| describe('parseAddress', () => { | ||
| it('should convert to Buffer', () => { | ||
| assert.match(vendorSpecific.setAddressCmd(0, "00:11:22:33:44:55").slice(3), Buffer.from([0x55, 0x44, 0x33, 0x22, 0x11, 0x00])) | ||
| }); | ||
|
|
||
| it('should not convert to Buffer and throw an Error', () => { | ||
| should.throws(function() { | ||
| vendorSpecific.setAddressCmd(0, "00:11:22:33:44") | ||
| }); | ||
| }); | ||
| }); | ||
| }); |