|
1 | 1 | // SPDX-License-Identifier: MIT |
2 | | -// Copyright (c) 2024 The Pybricks Authors |
| 2 | +// Copyright (c) 2024-2025 The Pybricks Authors |
3 | 3 |
|
4 | 4 | #include <pbdrv/config.h> |
5 | 5 |
|
|
9 | 9 |
|
10 | 10 | #include <pbdrv/battery.h> |
11 | 11 | #include <pbio/error.h> |
| 12 | +#include <pbdrv/gpio.h> |
| 13 | +#include "../gpio/gpio_ev3.h" |
| 14 | + |
| 15 | +#include <tiam1808/hw/hw_syscfg0_AM1808.h> |
| 16 | + |
| 17 | +static const pbdrv_gpio_t battery_type_gpio = PBDRV_GPIO_EV3_PIN(19, 7, 4, 8, 8); |
12 | 18 |
|
13 | 19 | void pbdrv_battery_init(void) { |
| 20 | + pbdrv_gpio_alt(&battery_type_gpio, SYSCFG_PINMUX19_PINMUX19_7_4_GPIO8_8); |
14 | 21 | } |
15 | 22 |
|
16 | 23 | pbio_error_t pbdrv_battery_get_voltage_now(uint16_t *value) { |
17 | | - // TODO. Return nominal value for now so we don't trigger low battery shutdown. |
| 24 | + // TODO. Calculate battery voltage based on ADC channel 4. |
| 25 | + // For now, return nominal value for now so we don't trigger low battery shutdown. |
18 | 26 | *value = 7200; |
19 | 27 | return PBIO_SUCCESS; |
20 | 28 | } |
21 | 29 |
|
22 | 30 | pbio_error_t pbdrv_battery_get_current_now(uint16_t *value) { |
| 31 | + // TODO. Calculate battery current based on ADC channel 3. |
23 | 32 | *value = 0; |
24 | 33 | return PBIO_ERROR_NOT_IMPLEMENTED; |
25 | 34 | } |
26 | 35 |
|
27 | 36 | pbio_error_t pbdrv_battery_get_type(pbdrv_battery_type_t *value) { |
28 | | - // TODO |
29 | | - *value = PBDRV_BATTERY_TYPE_UNKNOWN; |
30 | | - return PBIO_ERROR_NOT_IMPLEMENTED; |
| 37 | + if (pbdrv_gpio_input(&battery_type_gpio)) { |
| 38 | + *value = PBDRV_BATTERY_TYPE_ALKALINE; |
| 39 | + } else { |
| 40 | + *value = PBDRV_BATTERY_TYPE_LIION; |
| 41 | + } |
| 42 | + |
| 43 | + return PBIO_SUCCESS; |
31 | 44 | } |
32 | 45 |
|
33 | 46 | pbio_error_t pbdrv_battery_get_temperature(uint32_t *value) { |
| 47 | + // EV3 does not have a way to read the battery temperature. |
34 | 48 | *value = 0; |
35 | 49 | return PBIO_ERROR_NOT_SUPPORTED; |
36 | 50 | } |
|
0 commit comments