kingkevin
/
passkey_fw
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

able to receive first PD message

This commit is contained in:
hathach 2023-06-07 09:36:37 +07:00
parent e02eee7477
commit 914e82b25d
No known key found for this signature in database
GPG Key ID: F5D50C6D51D17CBA
1 changed files with 30 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

49
hw/bsp/stm32g4/family.c
View File

@ -72,7 +72,7 @@ void UCPD1_IRQHandler(void) {
uint32_t sr = UCPD1->SR; uint32_t sr = UCPD1->SR;
sr &= UCPD1->IMR; sr &= UCPD1->IMR;
TU_LOG1("UCPD1_IRQHandler: sr = 0x%08X\n", sr); // TU_LOG1("UCPD1_IRQHandler: sr = 0x%08X\n", sr);
if (sr & (UCPD_SR_TYPECEVT1 | UCPD_SR_TYPECEVT2)) { if (sr & (UCPD_SR_TYPECEVT1 | UCPD_SR_TYPECEVT2)) {
uint32_t vstate_cc[2]; uint32_t vstate_cc[2];
@ -83,6 +83,7 @@ void UCPD1_IRQHandler(void) {
uint32_t cr = UCPD1->CR; uint32_t cr = UCPD1->CR;
// TODO only support SNK for now, required highest voltage for now
if ((sr & UCPD_SR_TYPECEVT1) && (vstate_cc[0] == 3)) { if ((sr & UCPD_SR_TYPECEVT1) && (vstate_cc[0] == 3)) {
TU_LOG1("Attach CC1\n"); TU_LOG1("Attach CC1\n");
cr &= ~UCPD_CR_PHYCCSEL; cr &= ~UCPD_CR_PHYCCSEL;
@ -96,10 +97,12 @@ void UCPD1_IRQHandler(void) {
cr &= ~UCPD_CR_PHYRXEN; cr &= ~UCPD_CR_PHYRXEN;
} }
// Enable Interrupt if (cr & UCPD_CR_PHYRXEN) {
UCPD1->IMR |= UCPD_IMR_TXMSGDISCIE | UCPD_IMR_TXMSGSENTIE | UCPD_IMR_TXMSGABTIE | UCPD_IMR_TXUNDIE | // Enable Interrupt
/*UCPD_IMR_RXNEIE |*/ UCPD_IMR_RXORDDETIE | UCPD_IMR_RXHRSTDETIE | UCPD_IMR_RXOVRIE | UCPD_IMR_RXMSGENDIE | UCPD1->IMR |= UCPD_IMR_TXMSGDISCIE | UCPD_IMR_TXMSGSENTIE | UCPD_IMR_TXMSGABTIE | UCPD_IMR_TXUNDIE |
UCPD_IMR_HRSTDISCIE | UCPD_IMR_HRSTSENTIE; UCPD_IMR_RXNEIE | UCPD_IMR_RXORDDETIE | UCPD_IMR_RXHRSTDETIE | UCPD_IMR_RXOVRIE |
UCPD_IMR_RXMSGENDIE | UCPD_IMR_HRSTDISCIE | UCPD_IMR_HRSTSENTIE;
}
// Enable PD RX // Enable PD RX
UCPD1->CR = cr; UCPD1->CR = cr;
@ -108,32 +111,40 @@ void UCPD1_IRQHandler(void) {
UCPD1->ICR = UCPD_ICR_TYPECEVT1CF | UCPD_ICR_TYPECEVT2CF; UCPD1->ICR = UCPD_ICR_TYPECEVT1CF | UCPD_ICR_TYPECEVT2CF;
} }
//------------- Receive -------------//
if (sr & UCPD_SR_RXORDDET) { if (sr & UCPD_SR_RXORDDET) {
// SOP: Start of Packet // SOP: Start of Packet.
// TODO DMA later // uint8_t order_set = UCPD1->RX_ORDSET & UCPD_RX_ORDSET_RXORDSET_Msk;
uint8_t order_set = UCPD1->RX_ORDSET & UCPD_RX_ORDSET_RXORDSET_Msk;
TU_LOG1_HEX(order_set); // reset count when received SOP
pd_rx_count = 0;
// ack // ack
UCPD1->ICR = UCPD_ICR_RXORDDETCF; UCPD1->ICR = UCPD_ICR_RXORDDETCF;
} }
if ( sr & UCPD_SR_RXMSGEND) { if (sr & UCPD_SR_RXNE) {
// TODO DMA later
do {
pd_rx_buf[pd_rx_count++] = UCPD1->RXDR;
} while (UCPD1->SR & UCPD_SR_RXNE);
}
if (sr & UCPD_SR_RXMSGEND) {
// End of message // End of message
// uint32_t payload_size = UCPD1->RX_PAYSZ; uint32_t payload_size = UCPD1->RX_PAYSZ;
// TU_LOG1_HEX(payload_size);
//
// for(uint32_t i=0; i<payload_size; i++) {
// pd_rx_buf[i] = UCPD1->RXDR;
//
// TU_LOG1("0x%02X ", pd_rx_buf[i]);
// }
// TU_LOG1("\n");
// ack // ack
UCPD1->ICR = UCPD_ICR_RXMSGENDCF; UCPD1->ICR = UCPD_ICR_RXMSGENDCF;
} }
if (sr & UCPD_SR_RXOVR) {
TU_LOG1("RXOVR\n");
TU_LOG1_HEX(pd_rx_count);
// ack
UCPD1->ICR = UCPD_ICR_RXOVRCF;
}
// if (sr & UCPD_SR_RXNE) { // if (sr & UCPD_SR_RXNE) {
// uint8_t data = UCPD1->RXDR; // uint8_t data = UCPD1->RXDR;
// pd_rx_buf[pd_rx_count++] = data; // pd_rx_buf[pd_rx_count++] = data;