mirror of
https://gitee.com/qpy-solutions/tracker-v2.git
synced 2025-05-19 19:18:25 +08:00
87 lines
3.4 KiB
Python
87 lines
3.4 KiB
Python
# Copyright (c) Quectel Wireless Solution, Co., Ltd.All Rights Reserved.
|
|
#
|
|
# Licensed under the Apache License, Version 2.0 (the "License");
|
|
# you may not use this file except in compliance with the License.
|
|
# You may obtain a copy of the License at
|
|
#
|
|
# http://www.apache.org/licenses/LICENSE-2.0
|
|
#
|
|
# Unless required by applicable law or agreed to in writing, software
|
|
# distributed under the License is distributed on an "AS IS" BASIS,
|
|
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
# See the License for the specific language governing permissions and
|
|
# limitations under the License.
|
|
|
|
from misc import Power
|
|
from usr.logging import getLogger
|
|
|
|
log = getLogger(__name__)
|
|
|
|
BATTERY_OCV_TABLE = {
|
|
"nix_coy_mnzo2": {
|
|
55: {
|
|
4152: 100, 4083: 95, 4023: 90, 3967: 85, 3915: 80, 3864: 75, 3816: 70, 3773: 65, 3737: 60, 3685: 55,
|
|
3656: 50, 3638: 45, 3625: 40, 3612: 35, 3596: 30, 3564: 25, 3534: 20, 3492: 15, 3457: 10, 3410: 5, 3380: 0,
|
|
},
|
|
20: {
|
|
4143: 100, 4079: 95, 4023: 90, 3972: 85, 3923: 80, 3876: 75, 3831: 70, 3790: 65, 3754: 60, 3720: 55,
|
|
3680: 50, 3652: 45, 3634: 40, 3621: 35, 3608: 30, 3595: 25, 3579: 20, 3548: 15, 3511: 10, 3468: 5, 3430: 0,
|
|
},
|
|
0: {
|
|
4147: 100, 4089: 95, 4038: 90, 3990: 85, 3944: 80, 3899: 75, 3853: 70, 3811: 65, 3774: 60, 3741: 55,
|
|
3708: 50, 3675: 45, 3651: 40, 3633: 35, 3620: 30, 3608: 25, 3597: 20, 3585: 15, 3571: 10, 3550: 5, 3500: 0,
|
|
},
|
|
},
|
|
}
|
|
|
|
|
|
class Battery(object):
|
|
def __init__(self):
|
|
self.__energy = 100
|
|
self.__temp = 20
|
|
|
|
def __get_soc_from_dict(self, key, volt_arg):
|
|
if key in BATTERY_OCV_TABLE["nix_coy_mnzo2"]:
|
|
volts = sorted(BATTERY_OCV_TABLE["nix_coy_mnzo2"][key].keys(), reverse=True)
|
|
pre_volt = 0
|
|
volt_not_under = 0 # Determine whether the voltage is lower than the minimum voltage value of soc.
|
|
for volt in volts:
|
|
if volt_arg > volt:
|
|
volt_not_under = 1
|
|
soc1 = BATTERY_OCV_TABLE["nix_coy_mnzo2"][key].get(volt, 0)
|
|
soc2 = BATTERY_OCV_TABLE["nix_coy_mnzo2"][key].get(pre_volt, 0)
|
|
break
|
|
else:
|
|
pre_volt = volt
|
|
if pre_volt == 0: # Input Voltarg > Highest Voltarg
|
|
return soc1
|
|
elif volt_not_under == 0:
|
|
return 0
|
|
else:
|
|
return soc2 - (soc2 - soc1) * (pre_volt - volt_arg) // (pre_volt - volt)
|
|
|
|
def __get_soc(self, temp, volt_arg, bat_type="nix_coy_mnzo2"):
|
|
if bat_type == "nix_coy_mnzo2":
|
|
if temp > 30:
|
|
return self.__get_soc_from_dict(55, volt_arg)
|
|
elif temp < 10:
|
|
return self.__get_soc_from_dict(0, volt_arg)
|
|
else:
|
|
return self.__get_soc_from_dict(20, volt_arg)
|
|
|
|
def set_temp(self, temp):
|
|
# Set now temperature.
|
|
if isinstance(temp, int) or isinstance(temp, float):
|
|
self.__temp = temp
|
|
return True
|
|
return False
|
|
|
|
def get_voltage(self):
|
|
# Get voltage from vbat
|
|
# TODO: Get voltage by ADC
|
|
return int(sum([Power.getVbatt() for i in range(100)]) / 100)
|
|
|
|
def get_energy(self):
|
|
self.__energy = self.__get_soc(self.__temp, self.get_voltage())
|
|
return self.__energy
|