mirror of
https://github.com/Next-Flip/Momentum-Firmware.git
synced 2026-04-25 03:29:58 -07:00
Rename plugins to external
This commit is contained in:
89
applications/external/unitemp/interfaces/SPISensor.c
vendored
Normal file
89
applications/external/unitemp/interfaces/SPISensor.c
vendored
Normal file
@@ -0,0 +1,89 @@
|
||||
/*
|
||||
Unitemp - Universal temperature reader
|
||||
Copyright (C) 2022-2023 Victor Nikitchuk (https://github.com/quen0n)
|
||||
|
||||
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 <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <furi.h>
|
||||
#include <furi_hal.h>
|
||||
#include "SPISensor.h"
|
||||
|
||||
static uint8_t sensors_count = 0;
|
||||
|
||||
bool unitemp_spi_sensor_alloc(Sensor* sensor, char* args) {
|
||||
if(args == NULL) return false;
|
||||
|
||||
//Создание инстанса датчика SPI
|
||||
SPISensor* instance = malloc(sizeof(SPISensor));
|
||||
if(instance == NULL) {
|
||||
FURI_LOG_E(APP_NAME, "Sensor %s instance allocation error", sensor->name);
|
||||
return false;
|
||||
}
|
||||
sensor->instance = instance;
|
||||
|
||||
//Определение GPIO chip select
|
||||
int gpio = 255;
|
||||
sscanf(args, "%d", &gpio);
|
||||
instance->CS_pin = unitemp_gpio_getFromInt(gpio);
|
||||
if(instance->CS_pin == NULL) {
|
||||
FURI_LOG_E(APP_NAME, "Sensor %s GPIO setting error", sensor->name);
|
||||
free(instance);
|
||||
return false;
|
||||
}
|
||||
|
||||
instance->spi = malloc(sizeof(FuriHalSpiBusHandle));
|
||||
memcpy(instance->spi, &furi_hal_spi_bus_handle_external, sizeof(FuriHalSpiBusHandle));
|
||||
|
||||
instance->spi->cs = instance->CS_pin->pin;
|
||||
|
||||
bool status = sensor->type->allocator(sensor, args);
|
||||
|
||||
//Блокировка портов GPIO
|
||||
sensors_count++;
|
||||
unitemp_gpio_lock(unitemp_gpio_getFromInt(2), &SPI);
|
||||
unitemp_gpio_lock(unitemp_gpio_getFromInt(3), &SPI);
|
||||
unitemp_gpio_lock(unitemp_gpio_getFromInt(5), &SPI);
|
||||
unitemp_gpio_lock(instance->CS_pin, &SPI);
|
||||
return status;
|
||||
}
|
||||
|
||||
bool unitemp_spi_sensor_free(Sensor* sensor) {
|
||||
bool status = sensor->type->mem_releaser(sensor);
|
||||
unitemp_gpio_unlock(((SPISensor*)sensor->instance)->CS_pin);
|
||||
free(((SPISensor*)(sensor->instance))->spi);
|
||||
free(sensor->instance);
|
||||
|
||||
if(--sensors_count == 0) {
|
||||
unitemp_gpio_unlock(unitemp_gpio_getFromInt(2));
|
||||
unitemp_gpio_unlock(unitemp_gpio_getFromInt(3));
|
||||
unitemp_gpio_unlock(unitemp_gpio_getFromInt(5));
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
bool unitemp_spi_sensor_init(Sensor* sensor) {
|
||||
return sensor->type->initializer(sensor);
|
||||
}
|
||||
|
||||
bool unitemp_spi_sensor_deinit(Sensor* sensor) {
|
||||
UNUSED(sensor);
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
UnitempStatus unitemp_spi_sensor_update(Sensor* sensor) {
|
||||
return sensor->type->updater(sensor);
|
||||
}
|
||||
Reference in New Issue
Block a user