[457] | 1 | // https://github.com/ms-iotkithol-jp/IoTKitHoLV3/blob/master/PinKitIoTHubApp/PinKitIoTHubApp/PinKit/LightSensor.cs
|
---|
| 2 |
|
---|
| 3 | #include <math.h>
|
---|
| 4 | #include <kernel.h>
|
---|
| 5 | #include <t_syslog.h>
|
---|
| 6 | #include <target_syssvc.h>
|
---|
| 7 | #include "pinkit.h"
|
---|
| 8 | #include "kernel_cfg.h"
|
---|
| 9 |
|
---|
| 10 | ADC_Handle_t *aiLightSensor;
|
---|
| 11 |
|
---|
| 12 | volatile uint16_t LightSensorValue;
|
---|
| 13 |
|
---|
| 14 | /*
|
---|
| 15 | * ADC転送終了コールバック関数
|
---|
| 16 | */
|
---|
| 17 | static void HAL_ADC_ConvCpltCallback2(ADC_Handle_t* hadc)
|
---|
| 18 | {
|
---|
| 19 | LightSensorValue = adc_getvalue(aiLightSensor);
|
---|
| 20 | adc_end_int(hadc);
|
---|
| 21 | }
|
---|
| 22 |
|
---|
| 23 | bool LightSensor_Init()
|
---|
| 24 | {
|
---|
| 25 | ADC_Init_t aInit;
|
---|
| 26 | ADC_ChannelConf_t sConfig;
|
---|
| 27 | uint32_t event = 0;
|
---|
| 28 | int i;
|
---|
| 29 | Arduino_PortControlBlock *pcb;
|
---|
| 30 |
|
---|
| 31 | /*
|
---|
| 32 | * ADC1初期化
|
---|
| 33 | */
|
---|
| 34 | aInit.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV2;
|
---|
| 35 | aInit.Resolution = ADC_RESOLUTION_12B;
|
---|
| 36 | aInit.ScanConvMode = ADC_SCANMODE_DISABLE;
|
---|
| 37 | // aInit.ContinuousConvMode = ADC_CONTINUOUS_ENABLE;
|
---|
| 38 | aInit.ContinuousConvMode = ADC_CONTINUOUS_DISABLE;
|
---|
| 39 | aInit.DiscontinuousConvMode = ADC_DISCONTINUOUS_DISABLE;
|
---|
| 40 | aInit.NumDiscConversion = 0;
|
---|
| 41 | aInit.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
|
---|
| 42 | aInit.ExternalTrigConv = ADC_EXTERNALTRIGCONV_T1_CC1;
|
---|
| 43 | aInit.DataAlign = ADC_DATAALIGN_RIGHT;
|
---|
| 44 | aInit.NumConversion = 1;
|
---|
| 45 | aInit.DMAContinuousRequests = ADC_DMACONTINUOUS_ENABLE;
|
---|
| 46 | aInit.EOCSelection = ADC_EOC_SEQ_DISABLE;
|
---|
| 47 |
|
---|
| 48 | if((aiLightSensor = adc_init(ADC1_PORTID, &aInit)) == NULL){
|
---|
| 49 | /* Initialization Error */
|
---|
| 50 | syslog_0(LOG_ERROR, "## adc_init ERROR ##");
|
---|
| 51 | return false;
|
---|
| 52 | }
|
---|
| 53 | aiLightSensor->xfercallback = HAL_ADC_ConvCpltCallback2;
|
---|
| 54 |
|
---|
| 55 | /*
|
---|
| 56 | * ADCチャネル設定
|
---|
| 57 | */
|
---|
| 58 | pcb = getGpioTable(ANALOG_PIN, 0);
|
---|
| 59 | sConfig.Channel = ADC_CHANNEL_0;
|
---|
| 60 | sConfig.Rank = 1;
|
---|
| 61 | sConfig.SamplingTime = ADC_SAMPLETIME_480CYCLES;
|
---|
| 62 | sConfig.GpioBase = pcb->giobase;
|
---|
| 63 | sConfig.GpioPin = pcb->giopin;
|
---|
| 64 | if(adc_setupchannel(aiLightSensor, &sConfig) != E_OK){
|
---|
| 65 | /* Channel Configuration Error */
|
---|
| 66 | syslog_0(LOG_ERROR, "## adc_setupchannel ERROR ##");
|
---|
| 67 | return false;
|
---|
| 68 | }
|
---|
| 69 |
|
---|
| 70 | /*
|
---|
| 71 | * ADC DMAスタート
|
---|
| 72 | */
|
---|
| 73 | if(adc_start_int(aiLightSensor) != E_OK){
|
---|
| 74 | /* Start Conversation Error */
|
---|
| 75 | syslog_0(LOG_ERROR, "## adc_start_int ERROR ##");
|
---|
| 76 | return false;
|
---|
| 77 | }
|
---|
| 78 |
|
---|
| 79 | return true;
|
---|
| 80 | }
|
---|
| 81 |
|
---|
| 82 | bool LightSensor_Start()
|
---|
| 83 | {
|
---|
| 84 | if (aiLightSensor->status >= ADC_STATUS_EOC)
|
---|
| 85 | return false;
|
---|
| 86 |
|
---|
| 87 | /*
|
---|
| 88 | * ADC DMAスタート
|
---|
| 89 | */
|
---|
| 90 | if(adc_start_int(aiLightSensor) != E_OK){
|
---|
| 91 | /* Start Conversation Error */
|
---|
| 92 | syslog_0(LOG_NOTICE, "## adc_start_dma ERROR ##");
|
---|
| 93 | return false;
|
---|
| 94 | }
|
---|
| 95 |
|
---|
| 96 | return true;
|
---|
| 97 | }
|
---|
| 98 |
|
---|
| 99 | double LightSensor_TakeMeasurement()
|
---|
| 100 | {
|
---|
| 101 | if (aiLightSensor == NULL)
|
---|
| 102 | return 0.0;
|
---|
| 103 |
|
---|
| 104 | int raw = LightSensorValue << (16 - 12);
|
---|
| 105 |
|
---|
| 106 | return (double)raw / 65536.0;
|
---|
| 107 | }
|
---|