temp_meas.cpp

/*
 * This file is part of the tumanako_vc project.
 *
 * Copyright (C) 2010 Johannes Huebner <contact@johanneshuebner.com>
 * Copyright (C) 2010 Edward Cheeseman <cheesemanedward@gmail.com>
 * Copyright (C) 2009 Uwe Hermann <uwe@hermann-uwe.de>
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */
#define __TEMP_LU_TABLES
#include "temp_meas.h"
#include "my_math.h"
#include <stdint.h>

#define TABLEN(a) sizeof(a) / sizeof(a[0])

enum coeff { PTC, NTC };

typedef struct TempSensor
{
   int tempMin;
   int tempMax;
   uint8_t step;
   uint8_t tabSize;
   enum coeff coeff;
   const uint16_t *lookup;
} TEMP_SENSOR;

/* Temp sensor with JCurve */
static const uint16_t JCurve[] = { JCURVE };

/* Temp sensor in Semikron Skiip82 module */
static const uint16_t Semikron[] = { SEMIKRON };

/* Temp sensor in MBB600 IGBT module */
static const uint16_t mbb600[] = { MBB600 };

/* Temp sensor KTY83-110 */
static const uint16_t Kty83[] = { KTY83 };

/* Temp sensor KTY84-130 */
static const uint16_t Kty84[] = { KTY84 };

/* Temp sensor in Nissan Leaf motor */
static const uint16_t leaf[] = { LEAF };

/* Temp sensor in Nissan Leaf Gen 2 inverter heat sink */
static const uint16_t leafhs[] = { LEAFHS };

static const uint16_t kty81m[] = { KTY81_M };

/* Temp sensor embedded in Tesla rear motor */
static const uint16_t Tesla100k[] = { TESLA_100K };

/* Temp sensor embedded in Tesla rear heatsink */
static const uint16_t Tesla52k[] = { TESLA_52K };

/* Coolant fluid sensor in Tesla LDU */
static const uint16_t TeslaFluid[] = { TESLA_LDU_FLUID };

/* Temp sensor embedded in Tesla rear heatsink */
static const uint16_t Tesla10k[] = { TESLA_10K };

/* Temp sensor embedded in many Toyota motors */
static const uint16_t Toyota[] = { TOYOTA_M };

/* contributed by Fabian Brauss */
/* Temp sensor KTY81-121 */
static const uint16_t Kty81hs[] = { KTY81_HS };

/* Temp sensor PT1000 */
static const uint16_t Pt1000[] = { PT1000 };

/* Temp sensor NTC K45 2k2 (with parallel 2k!) */
static const uint16_t NtcK45[] = { NTCK45 };

static const TEMP_SENSOR sensors[] =
{
   { -25, 105, 5,  TABLEN(JCurve),    NTC, JCurve     },
   { 0,   100, 5,  TABLEN(Semikron),  PTC, Semikron   },
   { -5,  100, 5,  TABLEN(mbb600),    PTC, mbb600     },
   { -50, 150, 10, TABLEN(Kty81hs),   NTC, Kty81hs    },
   { -50, 150, 10, TABLEN(Pt1000),    PTC, Pt1000     },
   { -50, 150, 5,  TABLEN(NtcK45),    NTC, NtcK45     },
   { -10, 100, 10, TABLEN(leafhs),    NTC, leafhs     },
   { -50, 170, 10, TABLEN(Kty83),     PTC, Kty83      },
   { -40, 300, 10, TABLEN(Kty84),     PTC, Kty84      },
   { -20, 150, 10, TABLEN(leaf),      NTC, leaf       },
   { -50, 150, 10, TABLEN(kty81m),    PTC, kty81m     },
   { -20, 200, 5,  TABLEN(Toyota),    PTC, Toyota     },
   { -20, 190, 5,  TABLEN(Tesla100k), PTC, Tesla100k  },
   { 0,   100, 10, TABLEN(Tesla52k),  PTC, Tesla52k   },
   { 5,   100,  5, TABLEN(TeslaFluid),PTC, TeslaFluid },
   { -20, 190, 5,  TABLEN(Tesla10k),  PTC, Tesla10k   },
};

float TempMeas::Lookup(int digit, Sensors sensorId)
{
   if (sensorId >= TEMP_LAST) return 0;
   int index = sensorId >= TEMP_KTY83 ? sensorId - TEMP_KTY83 + NUM_HS_SENSORS : sensorId;

   const TEMP_SENSOR * sensor = &sensors[index];
   uint16_t last = sensor->lookup[0] + (sensor->coeff == NTC?-1:+1);

   for (uint32_t i = 0; i < sensor->tabSize; i++)
   {
      uint16_t cur = sensor->lookup[i];
      if ((sensor->coeff == NTC && cur >= digit) || (sensor->coeff == PTC && cur <= digit))
      {
         float a = sensor->coeff == NTC?cur - digit:digit - cur;
         float b = sensor->coeff == NTC?cur - last:last - cur;
         float interpolated = sensor->step * i + sensor->tempMin - sensor->step * a / b;
         return MIN(MAX(interpolated, sensor->tempMin),sensor->tempMax);
      }
      last = cur;
   }
   return sensor->tempMax;
}