/*
 * Copyright (c) 2006-2020, RT-Thread Development Team
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Change Logs:
 * Date           Author       Notes
 * 2020-08-18     guohp1128    the first version
 */

#include "drv_adc.h"

#ifdef RT_USING_ADC

struct rt_adc_device nrf5x_adc_device;

drv_nrfx_saadc_result_t results;
nrf_saadc_value_t       result_buff_cache[8];

static void nrf5x_saadc_event_hdr(nrfx_saadc_evt_t const * p_event)
{
    uint8_t i,j;
    if(p_event->type == NRFX_SAADC_EVT_DONE)
    {
        j = 0;
        for(i = 0; i < 8; i++)
        {
            if(results.channels[i].channel_index == i)
            {
                results.result_buffer[i] = result_buff_cache[j];
                j ++;
            }
        }
        results.done = 1;  
    }
}

static uint32_t get_channels_mask(void)
{
    uint8_t i;
    uint32_t mask = 0;
    for(i = 0; i < 8; i++)
    {
        if(results.channels[i].channel_index != 0xff)
        {
            mask |= (1 << results.channels[i].channel_index);
        }
    }
    return mask;
}

static void set_channels(drv_nrfx_saadc_channel_t * channel)
{
    uint8_t i;
    if(channel -> mode == NRF_SAADC_MODE_SINGLE_ENDED)
    {
        results.channels[channel->channel_num] = (nrfx_saadc_channel_t)NRFX_SAADC_DEFAULT_CHANNEL_SE(channel -> pin_p + 1, channel -> channel_num);
    }
    else if(channel -> mode == NRF_SAADC_MODE_DIFFERENTIAL)
    {
        results.channels[channel->channel_num] = (nrfx_saadc_channel_t)NRFX_SAADC_DEFAULT_CHANNEL_DIFFERENTIAL(channel -> pin_p + 1, channel -> pin_n + 1, channel -> channel_num);
    }
    results.channel_count = 0;
    for(i = 0; i < 8; i++)
    {
        if(results.channels[i].channel_index != 0xff)
        {
            results.channel_count ++;
        }
    }
}

/* channel: 0-7 */
static rt_err_t nrf5x_adc_enabled(struct rt_adc_device *device, rt_uint32_t channel, rt_bool_t enabled)
{      
    nrfx_err_t err_code = NRFX_SUCCESS; 
    uint8_t i,j;

    if (enabled)
    { 
        RT_ASSERT(device != RT_NULL);
        RT_ASSERT(device->parent.user_data != RT_NULL);
        
        drv_nrfx_saadc_channel_t * drv_channel_config = NULL;
        drv_channel_config = (drv_nrfx_saadc_channel_t *)device->parent.user_data;   
    
        set_channels(drv_channel_config);
        
        nrfx_saadc_channel_t channels_cache[results.channel_count];
        
        j = 0;
        for(i = 0; i < 8; i++)
        {
            if(results.channels[i].channel_index != 0xff)
            {
                channels_cache[j] = results.channels[i];
                j ++;
            }
        }
        
        err_code = nrfx_saadc_channels_config(channels_cache,results.channel_count);

        err_code = nrfx_saadc_simple_mode_set(get_channels_mask(),
                                      NRF_SAADC_RESOLUTION_12BIT,
                                      NRF_SAADC_OVERSAMPLE_DISABLED,
                                      nrf5x_saadc_event_hdr);
        
        err_code = nrfx_saadc_buffer_set(result_buff_cache, results.channel_count);                                     
    }
    else
    {
        results.channels[channel].channel_index = 0xff;
        
        results.channel_count = 0;
        for(i = 0; i < 8; i++)
        {
            if(results.channels[i].channel_index != 0xff)
            {
                results.channel_count ++;
            }
        }
        
        if(results.channel_count == 0)
        {
            nrfx_saadc_channel_t channels_cache[1];
            err_code = nrfx_saadc_channels_config(channels_cache, 0);
            return err_code;
        }
        else
        {
            nrfx_saadc_channel_t channels_cache[results.channel_count];
            
            j = 0;
            for(i = 0; i < 8; i++)
            {
                if(results.channels[i].channel_index != 0xff)
                {
                    channels_cache[j] = results.channels[i];
                    j ++;
                }
            }
            
            err_code = nrfx_saadc_channels_config(channels_cache,results.channel_count);

            err_code = nrfx_saadc_simple_mode_set(get_channels_mask(),
                                          NRF_SAADC_RESOLUTION_12BIT,
                                          NRF_SAADC_OVERSAMPLE_DISABLED,
                                          nrf5x_saadc_event_hdr);
            
            err_code = nrfx_saadc_buffer_set(result_buff_cache, results.channel_count);
        }
    }

    return err_code;   
}

static rt_err_t nrf5x_get_adc_value(struct rt_adc_device *device, rt_uint32_t channel, rt_uint32_t *value)
{
    nrfx_err_t err_code = NRFX_SUCCESS; 
    
    if (results.channels[channel].channel_index != 0xff)
    {
        results.done = 0;
        err_code = nrfx_saadc_mode_trigger();
        while(results.done == 0)
        {
            ;
        }
        * value = results.result_buffer[channel];
        results.done = 0;
    }
    
    return err_code;
}

static const struct rt_adc_ops nrf5x_adc_ops =
{
    .enabled = nrf5x_adc_enabled,
    .convert = nrf5x_get_adc_value,
};

int rt_hw_adc_init(void)
{
    int result = RT_EOK;
    uint8_t i;
    char name_buf[6] = {'S', 'A', 'A', 'D', 'C', 0};
    
    for(i = 0; i < 8; i++)
    {
        results.channels[i].channel_index = 0xff;
        results.result_buffer[i] = 0;
        results.channel_count = 0;
        results.done = 0;
    }
        
    /* initializing SAADC interrupt priority */
    if (nrfx_saadc_init(NRFX_SAADC_CONFIG_IRQ_PRIORITY) != NRFX_SUCCESS)
    {
        rt_kprintf("%s init failed", name_buf);
        rt_kprintf("The driver is already initialized.");
        result = -RT_ERROR;
    }
    else
    {
        /* register ADC device */
        if (rt_hw_adc_register(&nrf5x_adc_device, name_buf, &nrf5x_adc_ops, nrf5x_adc_device.parent.user_data) == RT_EOK)
        {
            rt_kprintf("%s init success", name_buf);
        }
        else
        {
            rt_kprintf("%s register failed", name_buf);
            result = -RT_ERROR;
        }
    }
    return result;
}
INIT_BOARD_EXPORT(rt_hw_adc_init);


/*test saadc*/
#include <drv_adc.h>

void saadc_sample(void)
{
    drv_nrfx_saadc_channel_t channel_config;
    rt_uint32_t result; 
    
    rt_adc_device_t adc_dev;
    adc_dev = (rt_adc_device_t)rt_device_find("SAADC");
    adc_dev->parent.user_data = &channel_config;
    
    channel_config = (drv_nrfx_saadc_channel_t){.mode = 0, .pin_p = 1, .pin_n = 1, .channel_num = 0};
    rt_adc_enable(adc_dev, channel_config.channel_num);
        
    channel_config = (drv_nrfx_saadc_channel_t){.mode = 0, .pin_p = 2, .pin_n = 1, .channel_num = 1};
    rt_adc_enable(adc_dev, channel_config.channel_num);
    
    channel_config = (drv_nrfx_saadc_channel_t){.mode = 0, .pin_p = 7, .pin_n = 1, .channel_num = 5};
    rt_adc_enable(adc_dev, channel_config.channel_num);
    
    int count = 1; 
    while(count++)
    {
        result = rt_adc_read(adc_dev, 0);
        rt_kprintf("saadc channel 0 value = %d, ",result);
        
        result = rt_adc_read(adc_dev, 1);
        rt_kprintf("saadc channel 1 value = %d, ",result);
        
        result = rt_adc_read(adc_dev, 5);
        rt_kprintf("saadc channel 5 value = %d",result);  
        
        rt_kprintf("\r\n"); 
        rt_thread_mdelay(1000);
    }
}
MSH_CMD_EXPORT(saadc_sample, saadc sample);

#endif /* RT_USING_ADC */