온도 센서 TMP235 삭제(IMU 온도로 대체)
This commit is contained in:
@@ -1,109 +0,0 @@
|
||||
/*******************************************************************************
|
||||
* @file tmp235.c
|
||||
* @brief TMP235-Q1 온도 센서 드라이버 (Zephyr SAADC, AIN3 = P0.05)
|
||||
*
|
||||
* 배터리 ADC와 동일한 방식 (ADC_DT_SPEC_GET_BY_NAME + adc_read_dt).
|
||||
* 채널 설정은 overlay channel@3에서 관리.
|
||||
*
|
||||
* 변환 공식:
|
||||
* V_mV = raw × 3600 / 4095 (1/6 gain, 0.6V ref, 12-bit)
|
||||
* T(°C × 100) = (V_mV - 500) × 10
|
||||
******************************************************************************/
|
||||
#include <zephyr/kernel.h>
|
||||
#include <zephyr/drivers/adc.h>
|
||||
#include <zephyr/devicetree.h>
|
||||
#include <limits.h>
|
||||
|
||||
#include "tmp235.h"
|
||||
#include "debug_print.h"
|
||||
|
||||
/*==============================================================================
|
||||
* ADC 디바이스트리 설정
|
||||
*============================================================================*/
|
||||
#define ZEPHYR_USER_NODE DT_PATH(zephyr_user)
|
||||
|
||||
static const struct adc_dt_spec temp_adc =
|
||||
ADC_DT_SPEC_GET_BY_NAME(ZEPHYR_USER_NODE, temperature);
|
||||
|
||||
static int16_t adc_buffer;
|
||||
|
||||
/*==============================================================================
|
||||
* 내부 변환
|
||||
*============================================================================*/
|
||||
|
||||
/**
|
||||
* @brief ADC raw → 온도 (°C × 100)
|
||||
*
|
||||
* V_mV = raw × 3600 / 4095
|
||||
* T_cdeg = (V_mV - 500) × 10
|
||||
*
|
||||
* 정수 연산 (오버플로 없음):
|
||||
* raw 최대 4095 → V_mV 최대 3600 → T_cdeg 최대 31000 → int32 OK
|
||||
*/
|
||||
static int16_t raw_to_cdeg(int16_t raw)
|
||||
{
|
||||
if (raw < 0) {
|
||||
raw = 0;
|
||||
}
|
||||
int32_t v_mv = (int32_t)raw * 3600 / 4095;
|
||||
int32_t t_cdeg = (v_mv - 500) * 10;
|
||||
return (int16_t)t_cdeg;
|
||||
}
|
||||
|
||||
/*==============================================================================
|
||||
* 공개 API
|
||||
*============================================================================*/
|
||||
|
||||
int temp_init(void)
|
||||
{
|
||||
if (!adc_is_ready_dt(&temp_adc)) {
|
||||
DBG_ERR("[TEMP] FAIL — ADC device not ready\r\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
int err = adc_channel_setup_dt(&temp_adc);
|
||||
if (err) {
|
||||
DBG_ERR("[TEMP] FAIL — channel setup (err=%d)\r\n", err);
|
||||
return -2;
|
||||
}
|
||||
|
||||
DBG_PRINTF("[TEMP] OK — TMP235 ch=%d, res=%d, os=%d\r\n",
|
||||
temp_adc.channel_id,
|
||||
temp_adc.resolution,
|
||||
temp_adc.oversampling);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int16_t temp_read_cdeg(void)
|
||||
{
|
||||
/* 매번 채널 재설정 (배터리 ADC와 SAADC 공유) */
|
||||
int err = adc_channel_setup_dt(&temp_adc);
|
||||
if (err) {
|
||||
DBG_ERR("[TEMP] FAIL — channel setup (err=%d)\r\n", err);
|
||||
return INT16_MIN;
|
||||
}
|
||||
|
||||
struct adc_sequence seq = {0};
|
||||
|
||||
err = adc_sequence_init_dt(&temp_adc, &seq);
|
||||
if (err) {
|
||||
DBG_ERR("[TEMP] FAIL — sequence init (err=%d)\r\n", err);
|
||||
return INT16_MIN;
|
||||
}
|
||||
|
||||
seq.buffer = &adc_buffer;
|
||||
seq.buffer_size = sizeof(adc_buffer);
|
||||
|
||||
err = adc_read_dt(&temp_adc, &seq);
|
||||
if (err) {
|
||||
DBG_ERR("[TEMP] FAIL — read (err=%d)\r\n", err);
|
||||
return INT16_MIN;
|
||||
}
|
||||
|
||||
int16_t t = raw_to_cdeg(adc_buffer);
|
||||
|
||||
DBG_PRINTF("[TEMP] raw=%d -> %d.%02d C\r\n",
|
||||
adc_buffer, t / 100, (t < 0 ? -t : t) % 100);
|
||||
|
||||
return t;
|
||||
}
|
||||
@@ -1,27 +0,0 @@
|
||||
/*******************************************************************************
|
||||
* @file tmp235.h
|
||||
* @brief TMP235-Q1 온도 센서 드라이버 (Zephyr SAADC, AIN3 = P0.05)
|
||||
*
|
||||
* 출력 공식: V = 500mV + 10mV/°C × T
|
||||
* → T(°C) = (V_mV - 500) / 10
|
||||
* → T(°Cx100) = (V_mV - 500) × 10
|
||||
******************************************************************************/
|
||||
|
||||
#ifndef TMP235_H__
|
||||
#define TMP235_H__
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
/**
|
||||
* @brief 온도 센서 초기화 — ADC 채널 설정
|
||||
* @return 0 성공, 음수 에러
|
||||
*/
|
||||
int temp_init(void);
|
||||
|
||||
/**
|
||||
* @brief 온도 1회 측정
|
||||
* @return 온도 (°C × 100), 에러 시 INT16_MIN
|
||||
*/
|
||||
int16_t temp_read_cdeg(void);
|
||||
|
||||
#endif /* TMP235_H__ */
|
||||
Reference in New Issue
Block a user