Import Mbed OS hard-float snapshot
This commit is contained in:
200
targets/TARGET_NUVOTON/TARGET_M480/analogout_api.c
Normal file
200
targets/TARGET_NUVOTON/TARGET_M480/analogout_api.c
Normal file
@@ -0,0 +1,200 @@
|
||||
/*
|
||||
* Copyright (c) 2018, Nuvoton Technology Corporation
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#include "analogout_api.h"
|
||||
|
||||
#if DEVICE_ANALOGOUT
|
||||
|
||||
#include "cmsis.h"
|
||||
#include "pinmap.h"
|
||||
#include "PeripheralPins.h"
|
||||
#include "gpio_api.h"
|
||||
#include "nu_modutil.h"
|
||||
|
||||
/* Maximum DAC modules */
|
||||
#define NU_DACMOD_MAXNUM 2
|
||||
/* Maximum DAC channels per module */
|
||||
#define NU_DACCHN_MAXNUM 1
|
||||
|
||||
static uint32_t dac_modinit_mask[NU_DACMOD_MAXNUM];
|
||||
|
||||
static const struct nu_modinit_s dac_modinit_tab[] = {
|
||||
{DAC_0_0, DAC_MODULE, 0, 0, DAC_RST, DAC_IRQn, NULL},
|
||||
{DAC_1_0, DAC_MODULE, 0, 0, DAC_RST, DAC_IRQn, NULL}
|
||||
};
|
||||
|
||||
void analogout_init(dac_t *obj, PinName pin)
|
||||
{
|
||||
obj->dac = (DACName) pinmap_peripheral(pin, PinMap_DAC);
|
||||
MBED_ASSERT(obj->dac != (DACName) NC);
|
||||
|
||||
const struct nu_modinit_s *modinit = get_modinit(obj->dac, dac_modinit_tab);
|
||||
MBED_ASSERT(modinit != NULL);
|
||||
MBED_ASSERT(modinit->modname == obj->dac);
|
||||
|
||||
/* Module index */
|
||||
uint32_t modidx = NU_MODINDEX(obj->dac);
|
||||
MBED_ASSERT(modidx < NU_DACMOD_MAXNUM);
|
||||
|
||||
/* Module subindex (aka channel) */
|
||||
uint32_t chn = NU_MODSUBINDEX(obj->dac);
|
||||
MBED_ASSERT(chn < NU_DACCHN_MAXNUM);
|
||||
|
||||
obj->pin = pin;
|
||||
|
||||
/* Wire pinout */
|
||||
pinmap_pinout(pin, PinMap_DAC);
|
||||
|
||||
DAC_T *dac_base = (DAC_T *) NU_MODBASE(obj->dac);
|
||||
|
||||
/* Module-level setup from here */
|
||||
|
||||
/* DAC0/DAC1 are designed to share the same RESET/clock/IRQ for group
|
||||
* function. So we:
|
||||
*
|
||||
* 1. Go to setup flow (analogout_init()) only when none of DAC0/DAC1
|
||||
* channels are activated.
|
||||
* 2. Go to windup flow (analogout_free()) only when all DAC0/DAC1
|
||||
* channels are deactivated.
|
||||
*/
|
||||
if ((! dac_modinit_mask[0]) && (! dac_modinit_mask[1])) {
|
||||
/* Select IP clock source and clock divider */
|
||||
CLK_SetModuleClock(modinit->clkidx, modinit->clksrc, modinit->clkdiv);
|
||||
|
||||
/* Enable IP clock */
|
||||
CLK_EnableModuleClock(modinit->clkidx);
|
||||
|
||||
/* Reset IP */
|
||||
SYS_ResetModule(modinit->rsetidx);
|
||||
|
||||
/* The conversion settling time is 8us when 12-bit input code transition from
|
||||
* lowest code (0x000) to highest code (0xFFF). */
|
||||
DAC_SetDelayTime(dac_base, 8);
|
||||
|
||||
/* Configure DAT data format to left-aligned
|
||||
* Effective 12-bits are aligned to left of 16-bit DAC_DAT. */
|
||||
DAC_ENABLE_LEFT_ALIGN(dac_base);
|
||||
}
|
||||
|
||||
/* Channel-level setup from here: */
|
||||
|
||||
/* Set the software trigger, enable DAC event trigger mode and enable D/A converter */
|
||||
DAC_Open(dac_base, chn, DAC_SOFTWARE_TRIGGER);
|
||||
|
||||
/* Mark channel allocated */
|
||||
dac_modinit_mask[modidx] |= 1 << chn;
|
||||
}
|
||||
|
||||
void analogout_free(dac_t *obj)
|
||||
{
|
||||
const struct nu_modinit_s *modinit = get_modinit(obj->dac, dac_modinit_tab);
|
||||
MBED_ASSERT(modinit != NULL);
|
||||
MBED_ASSERT(modinit->modname == obj->dac);
|
||||
|
||||
/* Module index */
|
||||
uint32_t modidx = NU_MODINDEX(obj->dac);
|
||||
MBED_ASSERT(modidx < NU_DACMOD_MAXNUM);
|
||||
|
||||
/* Module subindex (aka channel) */
|
||||
uint32_t chn = NU_MODSUBINDEX(obj->dac);
|
||||
MBED_ASSERT(chn < NU_DACCHN_MAXNUM);
|
||||
|
||||
DAC_T *dac_base = (DAC_T *) NU_MODBASE(obj->dac);
|
||||
|
||||
/* Channel-level windup from here */
|
||||
|
||||
/* Mark channel free */
|
||||
dac_modinit_mask[modidx] &= ~(1 << chn);
|
||||
|
||||
/* Close channel */
|
||||
DAC_Close(dac_base, chn);
|
||||
|
||||
/* Module-level windup from here: */
|
||||
|
||||
/* See analogout_init() for reason */
|
||||
if ((! dac_modinit_mask[0]) && (! dac_modinit_mask[1])) {
|
||||
|
||||
/* Disable IP clock */
|
||||
CLK_DisableModuleClock(modinit->clkidx);
|
||||
}
|
||||
|
||||
/* Free up pin */
|
||||
gpio_set(obj->pin);
|
||||
obj->pin = NC;
|
||||
}
|
||||
|
||||
void analogout_write(dac_t *obj, float value)
|
||||
{
|
||||
if (value <= 0.0f) {
|
||||
analogout_write_u16(obj, 0);
|
||||
} else if (value >= 1.0f) {
|
||||
analogout_write_u16(obj, 0xFFFF);
|
||||
} else {
|
||||
analogout_write_u16(obj, (uint16_t) (value * ((float) 0xFFFF)));
|
||||
}
|
||||
}
|
||||
|
||||
void analogout_write_u16(dac_t *obj, uint16_t value)
|
||||
{
|
||||
DAC_T *dac_base = (DAC_T *) NU_MODBASE(obj->dac);
|
||||
uint32_t chn = NU_MODSUBINDEX(obj->dac);
|
||||
|
||||
/* We should have configured DAC data format to left-aligned */
|
||||
MBED_ASSERT(dac_base->CTL & DAC_CTL_LALIGN_Msk);
|
||||
DAC_WRITE_DATA(dac_base, chn, value);
|
||||
|
||||
/* Clear the DAC conversion complete finish flag for safe */
|
||||
DAC_CLR_INT_FLAG(dac_base, chn);
|
||||
|
||||
/* Start A/D conversion */
|
||||
DAC_START_CONV(dac_base);
|
||||
|
||||
/* Wait for completed */
|
||||
while (DAC_IS_BUSY(dac_base, chn));
|
||||
}
|
||||
|
||||
float analogout_read(dac_t *obj)
|
||||
{
|
||||
uint32_t value = analogout_read_u16(obj);
|
||||
return (float) value * (1.0f / (float) 0xFFFF);
|
||||
}
|
||||
|
||||
uint16_t analogout_read_u16(dac_t *obj)
|
||||
{
|
||||
DAC_T *dac_base = (DAC_T *) NU_MODBASE(obj->dac);
|
||||
uint32_t chn = NU_MODSUBINDEX(obj->dac);
|
||||
|
||||
/* We should have configured DAC data format to left-aligned */
|
||||
MBED_ASSERT(dac_base->CTL & DAC_CTL_LALIGN_Msk);
|
||||
uint16_t dat12_4 = DAC_READ_DATA(dac_base, chn);
|
||||
/* Just 12 bits are effective. Convert to 16 bits.
|
||||
*
|
||||
* dat12_4 : b11b10b9b8 b7b6b5b4 b3b2b1b0 0000
|
||||
* dat16 : b11b10b9b8 b7b6b5b4 b3b2b1b0 b11b10b9b8
|
||||
*/
|
||||
uint16_t dat16 = (dat12_4 & 0xFFF0) | (dat12_4 >> 12);
|
||||
|
||||
return dat16;
|
||||
}
|
||||
|
||||
const PinMap *analogout_pinmap()
|
||||
{
|
||||
return PinMap_DAC;
|
||||
}
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user