fleg
/
OpenRTX
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Add CPS contact reading for GD-77 (currently not working for SPI flash issues)

This commit is contained in:
Federico Amedeo Izzo 2021-02-20 09:27:07 +01:00
parent 042ec2d5c1
commit a009ffa2d0
1 changed files with 23 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

26
platform/drivers/NVM/nvmem_GDx.c
View File

@ -385,7 +385,27 @@ int nvm_readZoneData(zone_t *zone, uint16_t pos)
int nvm_readContactData(contact_t *contact, uint16_t pos)
{
(void) contact;
(void) pos;
return -1;
if((pos <= 0) || (pos > maxNumContacts)) return -1;
W25Qx_wakeup();
delayUs(5);
gdxContact_t contactData;
// Note: pos is 1-based to be consistent with channels
uint32_t contactAddr = contactBaseAddr + (pos - 1) * sizeof(gdxContact_t);
W25Qx_readData(contactAddr, ((uint8_t *) &contactData), sizeof(gdxContact_t));
W25Qx_sleep();
// Check if contact is empty
if(wcslen((wchar_t *) contactData.name) == 0) return -1;
// Copy contact name
memcpy(contact->name, contactData.name, sizeof(contactData.name));
// Copy contact DMR ID
contact->id = (contactData.id[0] | contactData.id[1] << 8 | contactData.id[2] << 16);
// Copy contact details
contact->type = contactData.type;
contact->receive_tone = contactData.receive_tone ? true : false;
return 0;
}