adds mask for ssid number

This commit is contained in:
Eyck Jentzsch 2025-04-06 19:36:37 +02:00
parent 39969f0e29
commit c88caf9906

View File

@ -1,8 +1,8 @@
#ifndef _DEVICES_QSPI_H #ifndef _DEVICES_QSPI_H
#define _DEVICES_QSPI_H #define _DEVICES_QSPI_H
#include <stdint.h>
#include "gen/apb3spi.h" #include "gen/apb3spi.h"
#include <stdint.h>
#define qspi_t apb3spi_t #define qspi_t apb3spi_t
typedef struct { typedef struct {
@ -27,7 +27,8 @@ typedef struct {
#define SPI_STATUS_RSP_INT_FLAG = (1 << 9) #define SPI_STATUS_RSP_INT_FLAG = (1 << 9)
static inline void spi_configure(volatile qspi_t *qspi, spi_cfg *config) { static inline void spi_configure(volatile qspi_t *qspi, spi_cfg *config) {
set_apb3spi_config(qspi, (config->cpol << 0) | (config->cpha << 1) | (config->mode << 4)); set_apb3spi_config(qspi, (config->cpol << 0) | (config->cpha << 1) |
(config->mode << 4));
set_apb3spi_sclk_config(qspi, config->clkDivider); set_apb3spi_sclk_config(qspi, config->clkDivider);
set_apb3spi_ssgen_setup(qspi, config->ssSetup); set_apb3spi_ssgen_setup(qspi, config->ssSetup);
set_apb3spi_ssgen_hold(qspi, config->ssHold); set_apb3spi_ssgen_hold(qspi, config->ssHold);
@ -54,29 +55,36 @@ static inline uint32_t spi_rsp_occupied(volatile qspi_t* qspi){
} }
static inline void spi_write(volatile qspi_t *qspi, uint8_t data) { static inline void spi_write(volatile qspi_t *qspi, uint8_t data) {
while(spi_cmd_avail(qspi) == 0); while (spi_cmd_avail(qspi) == 0)
;
qspi->DATA = data | SPI_CMD_WRITE; qspi->DATA = data | SPI_CMD_WRITE;
} }
static inline uint8_t spi_read(volatile qspi_t *qspi) { static inline uint8_t spi_read(volatile qspi_t *qspi) {
while(spi_cmd_avail(qspi) == 0); while (spi_cmd_avail(qspi) == 0)
;
qspi->DATA = SPI_CMD_READ; qspi->DATA = SPI_CMD_READ;
while(spi_rsp_occupied(qspi) == 0); while (spi_rsp_occupied(qspi) == 0)
while((qspi->DATA & 0x80000000)==0); ;
while ((qspi->DATA & 0x80000000) == 0)
;
return qspi->DATA; return qspi->DATA;
} }
static inline void spi_select(volatile qspi_t *qspi, uint32_t slaveId) { static inline void spi_select(volatile qspi_t *qspi, uint32_t slaveId) {
while(spi_cmd_avail(qspi) == 0); while (spi_cmd_avail(qspi) == 0)
qspi->DATA = slaveId | 0x80 | SPI_CMD_SS; ;
qspi->DATA = (slaveId & 0x3) | 0x80 | SPI_CMD_SS;
} }
static inline void spi_deselect(volatile qspi_t *qspi, uint32_t slaveId) { static inline void spi_deselect(volatile qspi_t *qspi, uint32_t slaveId) {
while(spi_cmd_avail(qspi) == 0); while (spi_cmd_avail(qspi) == 0)
qspi->DATA = slaveId | SPI_CMD_SS; ;
qspi->DATA = (slaveId & 0x3) | SPI_CMD_SS;
} }
static inline void spi_wait_tx_idle(volatile qspi_t *qspi) { static inline void spi_wait_tx_idle(volatile qspi_t *qspi) {
while(spi_cmd_avail(qspi) < 0x20); while (spi_cmd_avail(qspi) < 0x20)
;
} }
#endif /* _DEVICES_QSPI_H */ #endif /* _DEVICES_QSPI_H */