nuttx/boards/arm/stm32/common/src/stm32_lis3dsh.c

116 lines
3.7 KiB
C
Raw Normal View History

/****************************************************************************
* boards/arm/stm32/common/src/stm32_lis3dsh.c
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you 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.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/config.h>
#include <errno.h>
#include <debug.h>
#include <stdio.h>
#include <nuttx/spi/spi.h>
#include <nuttx/sensors/lis3dsh.h>
#include <arch/board/board.h>
#include "stm32.h"
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* Name: attach_disc_lis3dsh
*
* Description:
* Attach the lis3dsh interrupt handler to PE0/EXT0 on the STM32F4 as wired
* on STM32F4Discovery
*
* Input Parameters:
2020-05-12 22:36:48 +02:00
* config - The lis3dsh instance configuration data containing
* the IRQ number, device ID and interrupt handler
* interrupt_handler - The interrupt handler to attach
* arg -
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
****************************************************************************/
2020-05-12 22:36:48 +02:00
int attach_disc_lis3dsh(struct lis3dsh_config_s *config,
xcpt_t interrupt_handler)
{
2020-05-12 22:36:48 +02:00
return stm32_gpiosetevent(BOARD_LIS3DSH_GPIO_EXT0, true, false, false,
interrupt_handler, NULL);
}
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* Name: board_lis3dsh_initialize
*
* Description:
* Initialize and register the LIS3DSH 3-axis accelerometer.
*
* Input Parameters:
* devno - The device number, used to build the device path as /dev/accN
* busno - The SPI bus number
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
****************************************************************************/
int board_lis3dsh_initialize(int devno, int busno)
{
static struct lis3dsh_config_s acc0_config;
char devpath[12];
struct spi_dev_s *spi;
int ret;
sninfo("Initializing LIS3DSH\n");
acc0_config.irq = 22;
acc0_config.spi_devid = 0;
acc0_config.attach = &attach_disc_lis3dsh;
spi = stm32_spibus_initialize(1);
if (!spi)
{
spiinfo("Failed to initialize SPI port\n");
ret = -ENODEV;
}
else
{
snprintf(devpath, 12, "/dev/acc%d", devno);
ret = lis3dsh_register(devpath, spi, &acc0_config);
}
return ret;
}