[457] | 1 | // https://github.com/ms-iotkithol-jp/IoTKitHoLV3/blob/master/PinKitIoTHubApp/PinKitIoTHubApp/PinKit/Temperature.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 *aiTemperature;
|
---|
| 11 |
|
---|
| 12 | // Adjust VR1 - Default 5000Ω
|
---|
| 13 | double VR1;
|
---|
| 14 |
|
---|
| 15 | // B constant - Default 3435Ω
|
---|
| 16 | double Bc;
|
---|
| 17 |
|
---|
| 18 | volatile uint16_t TemperatureValue;
|
---|
| 19 |
|
---|
| 20 | /*
|
---|
| 21 | * ADC転送終了コールバック関数
|
---|
| 22 | */
|
---|
| 23 | static void HAL_ADC_ConvCpltCallback2(ADC_Handle_t* hadc)
|
---|
| 24 | {
|
---|
| 25 | TemperatureValue = adc_getvalue(aiTemperature);
|
---|
| 26 | adc_end_int(hadc);
|
---|
| 27 | }
|
---|
| 28 |
|
---|
| 29 | bool Temperature_Init()
|
---|
| 30 | {
|
---|
| 31 | ADC_Init_t aInit;
|
---|
| 32 | ADC_ChannelConf_t sConfig;
|
---|
| 33 | uint32_t event = 0;
|
---|
| 34 | int i;
|
---|
| 35 | Arduino_PortControlBlock *pcb;
|
---|
| 36 |
|
---|
| 37 | VR1 = 5000.0;
|
---|
| 38 | Bc = 3435.0;
|
---|
| 39 |
|
---|
| 40 | /*
|
---|
| 41 | * ADC5初期化
|
---|
| 42 | */
|
---|
| 43 | aInit.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV2;
|
---|
| 44 | aInit.Resolution = ADC_RESOLUTION_12B;
|
---|
| 45 | aInit.ScanConvMode = ADC_SCANMODE_DISABLE;
|
---|
| 46 | aInit.ContinuousConvMode = ADC_CONTINUOUS_ENABLE;
|
---|
| 47 | aInit.DiscontinuousConvMode = ADC_DISCONTINUOUS_DISABLE;
|
---|
| 48 | aInit.NumDiscConversion = 0;
|
---|
| 49 | aInit.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
|
---|
| 50 | aInit.ExternalTrigConv = ADC_EXTERNALTRIGCONV_T1_CC1;
|
---|
| 51 | aInit.DataAlign = ADC_DATAALIGN_RIGHT;
|
---|
| 52 | aInit.NumConversion = 1;
|
---|
| 53 | aInit.DMAContinuousRequests = ADC_DMACONTINUOUS_DISABLE;
|
---|
| 54 | aInit.EOCSelection = ADC_EOC_SEQ_DISABLE;
|
---|
| 55 |
|
---|
| 56 | if((aiTemperature = adc_init(ADC3_PORTID, &aInit)) == NULL){
|
---|
| 57 | /* Initialization Error */
|
---|
| 58 | syslog_0(LOG_ERROR, "## adc_init ERROR ##");
|
---|
| 59 | return false;
|
---|
| 60 | }
|
---|
| 61 | aiTemperature->xfercallback = HAL_ADC_ConvCpltCallback2;
|
---|
| 62 |
|
---|
| 63 | /*
|
---|
| 64 | * ADCチャネル設定
|
---|
| 65 | */
|
---|
| 66 | pcb = getGpioTable(ANALOG_PIN, 5);
|
---|
| 67 | sConfig.Channel = ADC_CHANNEL_8;
|
---|
| 68 | sConfig.Rank = 1;
|
---|
| 69 | sConfig.SamplingTime = ADC_SAMPLETIME_480CYCLES;
|
---|
| 70 | sConfig.GpioBase = pcb->giobase;
|
---|
| 71 | sConfig.GpioPin = pcb->giopin;
|
---|
| 72 | if(adc_setupchannel(aiTemperature, &sConfig) != E_OK){
|
---|
| 73 | /* Channel Configuration Error */
|
---|
| 74 | syslog_0(LOG_ERROR, "## adc_setupchannel ERROR ##");
|
---|
| 75 | return false;
|
---|
| 76 | }
|
---|
| 77 |
|
---|
| 78 | /*
|
---|
| 79 | * ADC DMAスタート
|
---|
| 80 | */
|
---|
| 81 | if(adc_start_int(aiTemperature) != E_OK){
|
---|
| 82 | /* Start Conversation Error */
|
---|
| 83 | syslog_0(LOG_ERROR, "## adc_start_int ERROR ##");
|
---|
| 84 | return false;
|
---|
| 85 | }
|
---|
| 86 |
|
---|
| 87 | return true;
|
---|
| 88 | }
|
---|
| 89 |
|
---|
| 90 | bool Temperature_Start()
|
---|
| 91 | {
|
---|
| 92 | if (aiTemperature->status >= ADC_STATUS_EOC)
|
---|
| 93 | return false;
|
---|
| 94 |
|
---|
| 95 | /*
|
---|
| 96 | * ADC DMAスタート
|
---|
| 97 | */
|
---|
| 98 | if(adc_start_int(aiTemperature) != E_OK){
|
---|
| 99 | /* Start Conversation Error */
|
---|
| 100 | syslog_0(LOG_NOTICE, "## adc_start_int ERROR ##");
|
---|
| 101 | return false;
|
---|
| 102 | }
|
---|
| 103 |
|
---|
| 104 | return true;
|
---|
| 105 | }
|
---|
| 106 |
|
---|
| 107 | double Temperature_TakeMeasurement()
|
---|
| 108 | {
|
---|
| 109 | if (aiTemperature == NULL)
|
---|
| 110 | return -273.15;
|
---|
| 111 |
|
---|
| 112 | int raw = TemperatureValue << (16 - 12);
|
---|
| 113 |
|
---|
| 114 | double tk = 273.0;
|
---|
| 115 | double t25 = tk + 25.0;
|
---|
| 116 | double r25 = 10000.0;
|
---|
| 117 | double t = 1.0 / (log(VR1 * raw / (65536 - raw) / r25) / Bc + 1.0 / t25) - tk;
|
---|
| 118 | return t;
|
---|
| 119 | }
|
---|