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 | }
|
---|