license: update source file and licensing files
[libsi24] / libsi24.c
index 260506e..f4d6da5 100644 (file)
--- a/libsi24.c
+++ b/libsi24.c
@@ -1,11 +1,20 @@
-/**
- * File              : libsi24.c
- * Author            : Robin Krens <robin@robinkrens.nl>
- * Date              : 18.01.2023
- * Last Modified Date: 22.01.2023
- * Last Modified By  : Robin Krens <robin@robinkrens.nl>
+/* Copyright (C) 
+ * 2023 - Robin Krens
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ * 
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ * 
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
+ * 
  */
-
 #include <stdarg.h>
 #include <stdio.h>
 #include <stdint.h>
 #include "libsi24.h"
 #include "libsi24reg.h"
 
+#define DEBUG 0
+#define TIMEOUT 0xFFFF
+
 struct si24_t {
        const si24_opts_t *opts;
        const si24_ioctl_t *ctl;
        si24_event_handler_t eh;
-       si24_status_reg_t sr;
 };
 
 static uint8_t _reg_read(si24_t *si, uint8_t reg,
@@ -29,6 +40,7 @@ static uint8_t _reg_read(si24_t *si, uint8_t reg,
        
        memset(buf, 0, sz+1); 
        buf[0] = reg | SI24_R_REGISTER;
+
        
        if (si->ctl->write_and_read(buf, sz+1) == -1) {
                si24_event_t ev;
@@ -49,6 +61,14 @@ static uint8_t _reg_write(si24_t *si, uint8_t reg,
        
        buf[0] = reg | SI24_W_REGISTER;
        memcpy((buf+1), data, sz);
+       
+       if(DEBUG) {
+               printf("REG 0x%x:\t", reg);
+               for (int i = 1; i <= sz; ++i) {
+                       fprintf(stdout, "0x%x(%c)", buf[i], buf[i]);
+               }
+               fprintf(stdout, "\n");
+       }
 
        if (si->ctl->write_and_read(buf, sz+1) == -1) {
                si24_event_t ev;
@@ -64,7 +84,7 @@ static int _config(si24_t * si)
 {
        int ret = 0;
        uint8_t config_reg = (1 << PWR_UP);
-       uint8_t feature_reg = 0x2; /* default value */
+       uint8_t feature_reg = 0x0; /* default value */
        uint8_t rf_setup_reg = 0xE; /* default value */
        uint8_t setup_retr_reg = 0x3; /* default value */
        const uint8_t rf_ch_reg = 0x40; /* default value */
@@ -76,48 +96,58 @@ static int _config(si24_t * si)
        }
 
        if (params->enable_ack) {
+               if (params->mode == SEND_MODE) {
+                       setup_retr_reg = ARD(params->timeout) | ARC(params->retries);
+                       ret += _reg_write(si, SI24_REG_SETUP_RETR, &setup_retr_reg, 1);
+               }
+       } else {
+               if (params->mode == SEND_MODE) {
+                       feature_reg |= (1 << EN_DYN_ACK);
+                       ret += _reg_write(si, SI24_REG_FEATURE, &feature_reg, 1);
+               }
+       }
+
+       if (params->enable_dynpd) {
                uint8_t dyn = (1 << DPL_P0);
                ret += _reg_write(si, SI24_REG_DYNPD, &dyn, 1);
-               feature_reg |= (1 << EN_DYN_ACK);
+               feature_reg |= (1 << EN_DPL);
                ret += _reg_write(si, SI24_REG_FEATURE, &feature_reg, 1);
+       } else { /* fixed payload size */
+               if (params->mode == RECV_MODE) {
+                       ret += _reg_write(si, SI24_REG_RX_PW_P0, (uint8_t *) &params->payload, 1);
+               }
        }
 
-       uint8_t aw;
-       if (params->mac_addr & 0xF0000) {
-               aw = AW_5;
-               ret += _reg_write(si, SI24_REG_SETUP_AW, &aw, 1); 
-       } else if (params->mac_addr & 0xF000) {
-               aw = AW_4;
-               ret += _reg_write(si, SI24_REG_SETUP_AW, &aw, 1); 
-       } else {
-               aw = AW_3;
-               ret += _reg_write(si, SI24_REG_SETUP_AW, &aw, 1); 
-       }
+       uint8_t aw = AW_5;
+       ret += _reg_write(si, SI24_REG_SETUP_AW, &aw, 1); 
 
        if (params->mode == SEND_MODE && params->enable_ack) {
-               ret += _reg_write(si, SI24_REG_RX_ADDR_P0, (uint8_t *) &params->mac_addr, aw);
+               ret += _reg_write(si, SI24_REG_RX_ADDR_P0, params->mac_addr, sizeof(params->mac_addr));
        }
        
        if (params->mode == RECV_MODE) {
                config_reg |= (1 << PRIM_RX);
                uint8_t ch = 0x1;
                ret += _reg_write(si, SI24_REG_EN_RXADDR, &ch, 1); 
-               ret += _reg_write(si, SI24_REG_RX_ADDR_P0, (uint8_t *) &params->mac_addr, aw);
-               ret += _reg_write(si, SI24_REG_RX_PW_P0, (uint8_t *) &params->payload, 1);
+               ret += _reg_write(si, SI24_REG_RX_ADDR_P0, params->mac_addr, sizeof(params->mac_addr));
        } else {
-               ret += _reg_write(si, SI24_REG_TX_ADDR, (uint8_t *) &params->mac_addr, aw);
+               ret += _reg_write(si, SI24_REG_TX_ADDR, params->mac_addr, sizeof(params->mac_addr));
        }
 
        rf_setup_reg |= (params->speed << RF_DR_HIGH);
        rf_setup_reg |= (params->txpwr << RF_PWR);
        ret += _reg_write(si, SI24_REG_RF_SETUP, &rf_setup_reg, 1);
 
-       setup_retr_reg = ARD(params->timeout) | ARC(params->retries);
-       ret += _reg_write(si, SI24_REG_SETUP_RETR, &setup_retr_reg, 1);
 
        ret += _reg_write(si, SI24_REG_RF_CH, &rf_ch_reg, 1);
        ret += _reg_write(si, SI24_REG_CONFIG, &config_reg, 1);
 
+       if (params->mode == RECV_MODE) {
+               /* start accepting data immediately,
+                * for send mode it is onyl activated upon sending */
+               params->ioctl->chip_enable(1);
+       }
+
        return ret;
 }
 
@@ -143,77 +173,144 @@ si24_t* si24_init(const si24_opts_t *opts, si24_event_handler_t eh)
 size_t si24_send(si24_t* si, const unsigned char * buf, size_t size)
 {
        si24_event_t ev;
+       size_t bytes_sent = 0;
        uint16_t timeout = 0;
        int sz;
-       si24_status_reg_t flags;
-
+       uint8_t flags;
+       
        if (si->opts->mode == RECV_MODE)
                return -1;
 
-       _reg_read(si, 0x7, (uint8_t *) &flags, 1);
+       _reg_read(si, SI24_REG_STATUS, (uint8_t *) &flags, 1);
 
-       if (flags.bits.TX_FULL) {
+       if (flags & (1 << TX_FULL)) {
                ev.type = EV_TX_FULL;
                si->eh(si, &ev);
                return -1;
        }
 
-       for (size_t idx = 0; idx < size; idx += si->opts->payload) {
-               sz = (size - idx) < si->opts->payload ? (size - idx) : si->opts->payload;  
+       int payload = si->opts->payload;
+
+       if (si->opts->enable_dynpd)
+               payload = size > 32 ? 32 : size;
+
+       for (size_t idx = 0; idx < size; idx += payload) {
+               sz = (size - idx) < payload ? (size - idx) : payload;  
                if (si->opts->enable_ack) {
-                       _reg_write(si, SI24_W_TX_PAYLOAD, buf, sz);
-                       while ((!flags.bits.TX_DS || !flags.bits.MAX_RT) && timeout < 1000) {
-                               _reg_read(si, SI24_REG_STATUS, (uint8_t []){0x0}, 1);
+                       _reg_write(si, SI24_W_TX_PAYLOAD, buf + idx, sz);
+                       si->ctl->chip_enable(1);
+                       while ((!(flags & (1 << TX_DS)) && !(flags & (1 << MAX_RT))) && timeout < TIMEOUT) {
+                               _reg_read(si, SI24_REG_STATUS, &flags, 1);
                                timeout++;
                        }
-                       if (flags.bits.MAX_RT) {
+                       if (flags & (1 << MAX_RT)) {
                                ev.type = EV_ERR_MAX_RETRIES;
                                si->eh(si, &ev);
                                si24_reset(si);
-                               return -1;
+                               return bytes_sent;
                        }
 
                } else {
-                       _reg_write(si, SI24_W_TX_PAYLOAD_NO_ACK, buf, sz);
+                       _reg_write(si, SI24_W_TX_PAYLOAD_NO_ACK, buf + idx, sz);
                        si->ctl->chip_enable(1);
-                       while (!flags.bits.TX_DS && timeout < 1000) {
-                               _reg_read(si, SI24_REG_STATUS, (uint8_t []){0x0}, 1);
+                       while (!(flags & (1 << TX_DS)) && timeout < TIMEOUT) {
+                               _reg_read(si, SI24_REG_STATUS, &flags, 1);
                                timeout++;
                        }
                }
 
-               if (timeout >= 1000) {
+               if (timeout >= TIMEOUT) {
                        ev.type = EV_ERR_TIMEOUT;
                        si->eh(si, &ev);
                        si24_reset(si);
-                       return -1;
+                       return bytes_sent;
                }
+
+               flags |= (1 << TX_DS);
+               _reg_write(si, SI24_REG_STATUS, &flags, 1);
+               _reg_read(si, SI24_REG_STATUS, &flags, 1);
+               bytes_sent += sz;
                timeout = 0;
        }
-       
+
+       ev.type = EV_TX_COMPLETE;
+       si->eh(si, &ev);
        si->ctl->chip_enable(0);
 
-       return 0;
+       return bytes_sent;
 }
 
 size_t si24_recv(si24_t* si, unsigned char * buf, size_t size) 
 {
-       (void) buf;
-       (void) size;
+       si24_event_t ev;
+       size_t bytes_read = 0;
+       uint8_t p_size = si->opts->payload;
+       uint8_t tmpbuf[p_size];
+       uint8_t flags;
+       uint8_t fifo_flags;
+       
        if (si->opts->mode == SEND_MODE)
                return -1;
+
+       _reg_read(si, SI24_REG_STATUS, &flags, 1);
+
+       if (!(flags & (1 << RX_DR))) {
+               ev.type = EV_RX_EMPTY;
+               si->eh(si, &ev);
+               return bytes_read;
+       }
+
+       /* do not accept any new incoming data */
+       si->opts->ioctl->chip_enable(0);
+
+       _reg_read(si, SI24_REG_FIFO_SATUS, &fifo_flags, 1);
+       while(!(fifo_flags & (1 << RX_EMPTY)) &&
+                       bytes_read < size) {
+               
+               if (si->opts->enable_dynpd) {
+                       uint8_t d_sz = 0;
+                       _reg_read(si, SI24_RX_PL_WID, &d_sz, 1);
+                       p_size = d_sz;
+               }
+               int m_size = (size - bytes_read) > p_size ? p_size : (size - bytes_read);
+               _reg_read(si, SI24_R_RX_PAYLOAD, tmpbuf, m_size);
+
+               memcpy(buf + bytes_read, tmpbuf, m_size);
+               bytes_read += m_size;
+
+               _reg_read(si, SI24_REG_FIFO_SATUS, &fifo_flags, 1);
+       }
+
+       /* only clear data ready flag when FIFO is empty */
+       if (fifo_flags & (1 << RX_EMPTY)) {
+               flags |= (1 << RX_DR);
+               _reg_write(si, SI24_REG_STATUS, &flags, 1);
+       }
        
-       si24_status_reg_t flags;
-       _reg_read(si, 0x7, (uint8_t *) &flags, 1);
-       
-       if (!flags.bits.RX_DR)
-               return -1;
+       ev.type = EV_RX_COMPLETE;
+       si->eh(si, &ev);
 
-       return 0;
+       si->opts->ioctl->chip_enable(1);
+       
+       return bytes_read;
 }
 
 void si24_reset(si24_t* si)
 {
+       if (si->opts->mode == RECV_MODE) {
+               _reg_write(si, SI24_FLUSH_RX, 0, 0);
+       }
+       else if (si->opts->mode == SEND_MODE) {
+               _reg_write(si, SI24_FLUSH_TX, 0, 0);
+       }
+
+       uint8_t status_reg = {0};
+       status_reg |= (1 << RX_DR);
+       status_reg |= (1 << TX_DS);
+       status_reg |= (1 << MAX_RT);
+
+       _reg_write(si, SI24_REG_STATUS, (uint8_t *) &status_reg, 1);
+
        si->ctl->chip_enable(0);
 }
 
@@ -221,7 +318,3 @@ void si24_free(si24_t * si)
 {
        free(si);
 }
-
-int main(void)
-{
-}