sergiotarxz/nuttx
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

arch: cxd56xx: Fix SCU sensor data format

Browse Source 
Add offset setting for sensor data to be written to SCU math function.
Fix comments in function descriptions.
This commit is contained in:
SPRESENSE 2024-08-27 14:53:40 +09:00 committed by Alin Jerpelea
parent a6df724b4f
commit de8829f8cd
2 changed files with 8 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
arch/arm/include/cxd56xx/scu.h
View File

@ -443,7 +443,7 @@ int seq_setinstruction(struct seq_s *seq, const uint16_t *inst,
* param [in] seq : Sequencer instance * param [in] seq : Sequencer instance
* param [in] sample : Bytes per sample * param [in] sample : Bytes per sample
* param [in] offset : Start offset of sampling data * param [in] offset : Start offset of sampling data
* param [in] elemsize : Bytes of 1 element in sample * param [in] elemsize : Number of vector elements - 1 (e.g. 3 axis = 2)
* param [in] swapbyte : Enable/Disable byte swapping * param [in] swapbyte : Enable/Disable byte swapping
* *
* return OK(0) is success. negative value is failure. * return OK(0) is success. negative value is failure.

10
arch/arm/src/cxd56xx/cxd56_scu.c
View File

@ -777,8 +777,8 @@ static void seq_setbus(int sid, int bustype)
* sid - Sequencer ID * sid - Sequencer ID
* start - Sensor data start offset in sequencer picked * start - Sensor data start offset in sequencer picked
* bps - Bytes per sample * bps - Bytes per sample
* swap - Wwap bytes * swap - Swap bytes
* elem - Number of elements in sample * elem - Number of vector elements - 1 in sample
* *
****************************************************************************/ ****************************************************************************/
@ -789,6 +789,7 @@ static void seq_setdataformat(int sid, int start,
val = start & 0xf; val = start & 0xf;
val |= (bps & 0xf) << 4; val |= (bps & 0xf) << 4;
val |= (swap & 0x1) << 16; val |= (swap & 0x1) << 16;
val |= (start & 0xf) << 24;
val |= (elem & 0x3) << 28; val |= (elem & 0x3) << 28;
putreg32(val, SCUSEQ_OUT_FORMAT(sid)); putreg32(val, SCUSEQ_OUT_FORMAT(sid));
} }
@ -2814,7 +2815,7 @@ int seq_setinstruction(struct seq_s *seq, const uint16_t *inst,
* seq - An instance of sequencer * seq - An instance of sequencer
* sample - Size of sample (e.g. 16 bit 3 axis data = 6) * sample - Size of sample (e.g. 16 bit 3 axis data = 6)
* offset - Start offset of sampling data * offset - Start offset of sampling data
* elemsize - Size of 1 element (e.g. 16 bit 3 axis data = 2) * elemsize - Number of vector elements - 1 (e.g. 3 axis = 2)
* swapbyte - Enable/Disable byte swapping if available * swapbyte - Enable/Disable byte swapping if available
* *
****************************************************************************/ ****************************************************************************/
@ -2823,6 +2824,9 @@ void seq_setsample(struct seq_s *seq, uint8_t sample, uint8_t offset,
uint8_t elemsize, bool swapbyte) uint8_t elemsize, bool swapbyte)
{ {
DEBUGASSERT(seq); DEBUGASSERT(seq);
DEBUGASSERT(sample > 0 && sample <= 16);
DEBUGASSERT(offset >= 0 && offset < 15);
DEBUGASSERT(elemsize >= 0 && elemsize < 3);
seq->sample = sample; seq->sample = sample;