surenyi
3 weeks ago
11 changed files with 1204 additions and 536 deletions
@ -0,0 +1,127 @@ |
|||
# SPDX-License-Identifier: GPL-2.0 |
|||
# |
|||
# clang-format configuration file. Intended for clang-format >= 11. |
|||
# |
|||
# For more information, see: |
|||
# |
|||
# Documentation/process/clang-format.rst |
|||
# https://clang.llvm.org/docs/ClangFormat.html |
|||
# https://clang.llvm.org/docs/ClangFormatStyleOptions.html |
|||
# |
|||
# :lua vim.lsp.buf.format({timeout=2000}) |
|||
--- |
|||
AccessModifierOffset: -4 |
|||
AlignAfterOpenBracket: Align |
|||
AlignConsecutiveAssignments: false |
|||
AlignConsecutiveDeclarations: false |
|||
AlignEscapedNewlines: Left |
|||
AlignOperands: true |
|||
AlignTrailingComments: false |
|||
AllowAllParametersOfDeclarationOnNextLine: false |
|||
AllowShortBlocksOnASingleLine: false |
|||
AllowShortCaseLabelsOnASingleLine: false |
|||
AllowShortFunctionsOnASingleLine: None |
|||
AllowShortIfStatementsOnASingleLine: false |
|||
AllowShortLoopsOnASingleLine: false |
|||
AlwaysBreakAfterDefinitionReturnType: None |
|||
AlwaysBreakAfterReturnType: None |
|||
AlwaysBreakBeforeMultilineStrings: false |
|||
AlwaysBreakTemplateDeclarations: false |
|||
BinPackArguments: true |
|||
BinPackParameters: true |
|||
BraceWrapping: |
|||
AfterClass: false |
|||
AfterControlStatement: false |
|||
AfterEnum: false |
|||
AfterFunction: true |
|||
AfterNamespace: true |
|||
AfterObjCDeclaration: false |
|||
AfterStruct: false |
|||
AfterUnion: false |
|||
AfterExternBlock: false |
|||
BeforeCatch: false |
|||
BeforeElse: false |
|||
IndentBraces: false |
|||
SplitEmptyFunction: true |
|||
SplitEmptyRecord: true |
|||
SplitEmptyNamespace: true |
|||
BreakBeforeBinaryOperators: None |
|||
BreakBeforeBraces: Custom |
|||
BreakBeforeInheritanceComma: false |
|||
BreakBeforeTernaryOperators: false |
|||
BreakConstructorInitializersBeforeComma: false |
|||
BreakConstructorInitializers: BeforeComma |
|||
BreakAfterJavaFieldAnnotations: false |
|||
BreakStringLiterals: false |
|||
ColumnLimit: 80 |
|||
CommentPragmas: '^ IWYU pragma:' |
|||
CompactNamespaces: false |
|||
ConstructorInitializerAllOnOneLineOrOnePerLine: false |
|||
ConstructorInitializerIndentWidth: 4 |
|||
ContinuationIndentWidth: 4 |
|||
Cpp11BracedListStyle: false |
|||
DerivePointerAlignment: false |
|||
DisableFormat: false |
|||
ExperimentalAutoDetectBinPacking: false |
|||
FixNamespaceComments: false |
|||
|
|||
# Taken from: |
|||
# git grep -h '^#define [^[:space:]]*for_each[^[:space:]]*(' include/ tools/ \ |
|||
# | sed "s,^#define \([^[:space:]]*for_each[^[:space:]]*\)(.*$, - '\1'," \ |
|||
# | LC_ALL=C sort -u |
|||
ForEachMacros: |
|||
- 'list_for_each' |
|||
|
|||
IncludeBlocks: Preserve |
|||
IncludeCategories: |
|||
- Regex: '.*' |
|||
Priority: 1 |
|||
IncludeIsMainRegex: '(Test)?$' |
|||
IndentCaseLabels: false |
|||
IndentGotoLabels: false |
|||
IndentPPDirectives: None |
|||
IndentWidth: 4 |
|||
IndentWrappedFunctionNames: false |
|||
JavaScriptQuotes: Leave |
|||
JavaScriptWrapImports: true |
|||
KeepEmptyLinesAtTheStartOfBlocks: false |
|||
MacroBlockBegin: '' |
|||
MacroBlockEnd: '' |
|||
MaxEmptyLinesToKeep: 1 |
|||
NamespaceIndentation: None |
|||
ObjCBinPackProtocolList: Auto |
|||
ObjCBlockIndentWidth: 4 |
|||
ObjCSpaceAfterProperty: true |
|||
ObjCSpaceBeforeProtocolList: true |
|||
|
|||
# Taken from git's rules |
|||
PenaltyBreakAssignment: 10 |
|||
PenaltyBreakBeforeFirstCallParameter: 30 |
|||
PenaltyBreakComment: 10 |
|||
PenaltyBreakFirstLessLess: 0 |
|||
PenaltyBreakString: 10 |
|||
PenaltyExcessCharacter: 100 |
|||
PenaltyReturnTypeOnItsOwnLine: 60 |
|||
|
|||
PointerAlignment: Right |
|||
ReflowComments: false |
|||
SortIncludes: false |
|||
SortUsingDeclarations: false |
|||
SpaceAfterCStyleCast: false |
|||
SpaceAfterTemplateKeyword: true |
|||
SpaceBeforeAssignmentOperators: true |
|||
SpaceBeforeCtorInitializerColon: true |
|||
SpaceBeforeInheritanceColon: true |
|||
SpaceBeforeParens: ControlStatementsExceptForEachMacros |
|||
SpaceBeforeRangeBasedForLoopColon: true |
|||
SpaceInEmptyParentheses: false |
|||
SpacesBeforeTrailingComments: 1 |
|||
SpacesInAngles: false |
|||
SpacesInContainerLiterals: false |
|||
SpacesInCStyleCastParentheses: false |
|||
SpacesInParentheses: false |
|||
SpacesInSquareBrackets: false |
|||
Standard: Cpp03 |
|||
TabWidth: 4 |
|||
UseTab: Never |
|||
... |
|||
@ -0,0 +1,20 @@ |
|||
/* 40vxbSm2310SpiDev.cdf - Component configuration file */ |
|||
|
|||
/* |
|||
* modification history |
|||
* -------------------- |
|||
* 2024-10-16: surenyi written. |
|||
*/ |
|||
|
|||
Component DRV_SPIDEV_SM2130 { |
|||
NAME State Micro SM2130 SPI 1553B vxBus Driver |
|||
SYNOPSIS This enables access to SM2310 1553B protocol chip |
|||
INIT_RTN vxbSm2130SpiDevRegister(); |
|||
PROTOTYPE void vxbSm2130SpiDevRegister (void); |
|||
_INIT_ORDER hardWareInterFaceBusInit |
|||
INIT_AFTER INCLUDE_SPI_BUS |
|||
REQUIRES INCLUDE_VXBUS \ |
|||
INCLUDE_PLB_BUS \ |
|||
INCLUDE_SPI_BUS |
|||
_CHILDREN FOLDER_DRIVERS |
|||
} |
|||
File diff suppressed because it is too large
@ -0,0 +1,302 @@ |
|||
#include <vxWorks.h> |
|||
#include <stdio.h> |
|||
#include <string.h> |
|||
#include <logLib.h> |
|||
#include <vxBusLib.h> |
|||
#include <semLib.h> |
|||
#include <taskLib.h> |
|||
#include <sysLib.h> |
|||
#include <tickLib.h> |
|||
#include <hwif/vxbus/vxBus.h> |
|||
#include <hwif/vxbus/hwConf.h> |
|||
#include <hwif/vxbus/vxbPlbLib.h> |
|||
#include <hwif/util/hwMemLib.h> |
|||
#include <hwif/util/vxbParamSys.h> |
|||
|
|||
#include <hwif/vxbus/vxbSpiLib.h> |
|||
#include "vxbSm2130SpiDev.h" |
|||
#include <usrLib.h> |
|||
|
|||
/* locals */ |
|||
LOCAL void sm2130SpiDevShow(VXB_DEVICE_ID pDev, int verbose); |
|||
LOCAL INT32 spiDevRead(VXB_DEVICE_ID pDev, UINT8 cmd); |
|||
LOCAL STATUS spiDevWrite(VXB_DEVICE_ID pDev, UINT8 cmd, UINT16 var); |
|||
|
|||
/* VxBus methods */ |
|||
LOCAL void sm2130SpiDevInstInit(VXB_DEVICE_ID pDev); |
|||
LOCAL void sm2130SpiDevInstInit2(VXB_DEVICE_ID pDev); |
|||
LOCAL void sm2130SpiDevInstConnect(VXB_DEVICE_ID pDev); |
|||
LOCAL STATUS sm2130SpiDevInstUnlink(VXB_DEVICE_ID pDev, void *unused); |
|||
|
|||
/* Structs */ |
|||
|
|||
LOCAL struct drvBusFuncs sm2130SpiDevFuncs = { |
|||
sm2130SpiDevInstInit, /* devInstanceInit */ |
|||
sm2130SpiDevInstInit2, /* devInstanceInit2 */ |
|||
sm2130SpiDevInstConnect /* devConnect */ |
|||
}; |
|||
|
|||
/* Publish the methods for the resources controlled with this file */ |
|||
|
|||
LOCAL struct vxbDeviceMethod sm2130SpiDevMethods[] = { |
|||
DEVMETHOD(busDevShow, sm2130SpiDevShow), |
|||
DEVMETHOD(vxbDrvUnlink, sm2130SpiDevInstUnlink), |
|||
{ 0, 0 } |
|||
}; |
|||
|
|||
LOCAL struct vxbSpiRegister sm2130SpiDevRegister = { |
|||
{ |
|||
NULL, /* pNext */ |
|||
VXB_DEVID_DEVICE, /* devID */ |
|||
VXB_BUSID_SPI, /* busID = SPI */ |
|||
VXB_VER_4_0_0, /* vxbVersion */ |
|||
SPI_DEV_SM2130, /* drvName */ |
|||
&sm2130SpiDevFuncs, /* pDrvBusFuncs */ |
|||
sm2130SpiDevMethods, /* pMethods */ |
|||
NULL, //sm2130Probe, /* devProbe */
|
|||
NULL, /* pParamDefaults */ |
|||
}, |
|||
}; |
|||
/*
|
|||
* |
|||
* vxbSm2130SpiDevRegister - register with the VxBus subsystem |
|||
* |
|||
* This routine registers the driver to VxBus Systems. |
|||
* |
|||
* RETURNS: N/A |
|||
* |
|||
* ERRNO: N/A |
|||
* |
|||
* \NOMANUAL |
|||
*/ |
|||
void vxbSm2130SpiDevRegister(void) |
|||
{ |
|||
(void)vxbDevRegister((struct vxbDevRegInfo *)&sm2130SpiDevRegister); |
|||
} |
|||
|
|||
/*
|
|||
* |
|||
* sm2130SpiDevInstInit - first level initialization routine of spi flash device |
|||
* |
|||
* RETURNS: N/A |
|||
* |
|||
* ERRNO: N/A |
|||
*/ |
|||
LOCAL void sm2130SpiDevInstInit(VXB_DEVICE_ID pDev) |
|||
{ |
|||
SM2130_SPI_DEV *pDrvCtrl; |
|||
|
|||
/* Check for vaild parameter */ |
|||
VXB_ASSERT_NONNULL_V(pDev); |
|||
|
|||
pDrvCtrl = (SM2130_SPI_DEV *)hwMemAlloc(sizeof(SM2130_SPI_DEV)); |
|||
if (pDrvCtrl == NULL) { |
|||
return; |
|||
} |
|||
|
|||
pDrvCtrl->pDev = pDev; |
|||
pDev->pDrvCtrl = pDrvCtrl; |
|||
|
|||
pDrvCtrl->read = spiDevRead; |
|||
pDrvCtrl->write = spiDevWrite; |
|||
|
|||
vxbNextUnitGet(pDev); |
|||
} |
|||
|
|||
/*
|
|||
* |
|||
* sm2130SpiDevInstInit2 - first level initialization routine of spi flash device |
|||
* |
|||
* |
|||
* RETURNS: N/A |
|||
* |
|||
* ERRNO: N/A |
|||
*/ |
|||
LOCAL void sm2130SpiDevInstInit2(VXB_DEVICE_ID pDev) |
|||
{ |
|||
SM2130_SPI_DEV *pDrvCtrl; |
|||
FUNCPTR pFunc; |
|||
|
|||
/* Check for vaild parameter */ |
|||
VXB_ASSERT_NONNULL_V(pDev); |
|||
|
|||
pDrvCtrl = (SM2130_SPI_DEV *)pDev->pDrvCtrl; |
|||
|
|||
/* Mutex semaphore is initialized and necessary at this point */ |
|||
pDrvCtrl->muteSem = semMCreate(SPI_DEV_MUTEX_OPT); |
|||
|
|||
pFunc = vxbDevMethodGet(vxbDevParent(pDev), |
|||
(VXB_METHOD_ID)vxbSpiSpecialGet_desc); |
|||
|
|||
/* Retrieve the SPI master special information */ |
|||
if (pFunc != NULL) |
|||
(*pFunc)(vxbDevParent(pDev), &pDrvCtrl->specialInfo); |
|||
} |
|||
|
|||
/*
|
|||
* sm2130SpiDevInstConnect - third level initialization routine of spi flash |
|||
* |
|||
* This function implements the VxBus instConnect handler for a SPI Flash |
|||
* device instance. |
|||
* |
|||
* RETURNS: N/A |
|||
* |
|||
* ERRNO: N/A |
|||
*/ |
|||
LOCAL void sm2130SpiDevInstConnect(VXB_DEVICE_ID pDev) |
|||
{ |
|||
SM2130_SPI_DEV *pDrvCtrl; |
|||
|
|||
/* Check for vaild parameter */ |
|||
VXB_ASSERT_NONNULL_V(pDev); |
|||
|
|||
pDrvCtrl = (SM2130_SPI_DEV *)pDev->pDrvCtrl; |
|||
} |
|||
|
|||
/*
|
|||
* sm2130SpiDevInstUnlink - VxBus unlink handler |
|||
* |
|||
* This function shuts down a SPI Flash device instance in response to an |
|||
* unlink event from VxBus. This may occur if our VxBus instance has been |
|||
* terminated, or if the driver has been unloaded. |
|||
* |
|||
* RETURNS: OK always. |
|||
* |
|||
* ERRNO: N/A |
|||
*/ |
|||
LOCAL STATUS sm2130SpiDevInstUnlink(VXB_DEVICE_ID pDev, void *unused) |
|||
{ |
|||
SM2130_SPI_DEV *pDrvCtrl; |
|||
|
|||
/* Check for vaild parameter */ |
|||
VXB_ASSERT_NONNULL_V(pDev); |
|||
|
|||
pDrvCtrl = (SM2130_SPI_DEV *)pDev->pDrvCtrl; |
|||
|
|||
if (pDrvCtrl->muteSem) { |
|||
(void)semTake(pDrvCtrl->muteSem, WAIT_FOREVER); |
|||
|
|||
(void)semDelete(pDrvCtrl->muteSem); |
|||
pDrvCtrl->muteSem = NULL; |
|||
} |
|||
#ifndef _VXBUS_BASIC_HWMEMLIB |
|||
hwMemFree((char *)pDrvCtrl); |
|||
#endif /* _VXBUS_BASIC_HWMEMLIB */ |
|||
pDev->pDrvCtrl = NULL; |
|||
return OK; |
|||
} |
|||
|
|||
/*
|
|||
* |
|||
* sm2130SpiDevShow - show the SPI 1553B info. |
|||
* |
|||
* This routine show the SPI flash info by vxBusShow. |
|||
* |
|||
* RETURNS: N/A |
|||
* |
|||
* ERRNO: N/A |
|||
*/ |
|||
LOCAL void sm2130SpiDevShow(VXB_DEVICE_ID pDev, int verbose) |
|||
{ |
|||
printf(" %s unit %d on %s @ 0x%08x", pDev->pName, pDev->unitNumber, |
|||
vxbBusTypeString(pDev->busID), pDev); |
|||
printf(" with busInfo %p\n", pDev->u.pSubordinateBus); |
|||
|
|||
if (verbose) { |
|||
|
|||
} |
|||
|
|||
return; |
|||
} |
|||
|
|||
/*
|
|||
* spiDevWrite - VxBus SPI device write by name support routine |
|||
* |
|||
* This routine firstly finds the VXB_DEVICE_ID for a given instance |
|||
* identified by name and unit number, then call vxbI2cDevWrite() routine to |
|||
* write the device. |
|||
* |
|||
* RETURNS: OK/ERROR |
|||
* |
|||
* ERRNO : N/A |
|||
*/ |
|||
LOCAL STATUS spiDevWrite(VXB_DEVICE_ID pDev, UINT8 cmd, UINT16 var) |
|||
{ |
|||
SPI_TRANSFER transInfo = {NULL, NULL, 0, 0, 0}; |
|||
UINT8 buf[3]; |
|||
/* Check if the pDev pointer is valid */ |
|||
|
|||
VXB_ASSERT(pDev != NULL, ERROR) |
|||
buf[0] = cmd; |
|||
buf[1] = var & 0xff; |
|||
buf[1] = (var >> 8) & 0xff; |
|||
|
|||
transInfo.txBuf = buf; |
|||
transInfo.txLen = 3; |
|||
|
|||
return (vxbSpiTransfer(pDev, &transInfo)); |
|||
} |
|||
|
|||
/*
|
|||
* spiDevRead - read register routine |
|||
* |
|||
* This is the SPI flash status /config register read out routine. |
|||
* |
|||
* RETURNS: status register value. |
|||
* |
|||
* ERRNO: N/A |
|||
*/ |
|||
LOCAL INT32 spiDevRead(VXB_DEVICE_ID pDev, UINT8 cmd) |
|||
{ |
|||
SPI_TRANSFER transInfo = {NULL, NULL, 0, 0, 0}; |
|||
UINT16 buffer = 0xffff; |
|||
|
|||
/* check if the pDev pointer is valid */ |
|||
|
|||
VXB_ASSERT(pDev != NULL, ERROR) |
|||
|
|||
transInfo.txBuf = &cmd; |
|||
transInfo.txLen = 1; |
|||
transInfo.rxBuf = (UINT8 *)&buffer; |
|||
transInfo.rxLen = 2; |
|||
|
|||
if (vxbSpiTransfer(pDev, &transInfo) != OK) |
|||
return ERROR; |
|||
else |
|||
return (buffer); |
|||
} |
|||
|
|||
|
|||
INT32 sm2130Read(UINT8 cmd) |
|||
{ |
|||
VXB_DEVICE_ID pDev; |
|||
SM2130_SPI_DEV * pCtrl; |
|||
|
|||
pDev = vxbInstByNameFind(SPI_DEV_SM2130, 0); |
|||
if (pDev == NULL) { |
|||
return ERROR; |
|||
} |
|||
|
|||
pCtrl = pDev->pDrvCtrl; |
|||
|
|||
/* printf("pDev @ %p, pCtrl %p\n", pDev, pCtrl); */ |
|||
|
|||
return pCtrl->read(pDev, cmd); |
|||
} |
|||
|
|||
STATUS sm2130Write(UINT8 cmd, UINT16 var) |
|||
{ |
|||
VXB_DEVICE_ID pDev; |
|||
SM2130_SPI_DEV * pCtrl; |
|||
|
|||
pDev = vxbInstByNameFind(SPI_DEV_SM2130, 0); |
|||
if (pDev == NULL) { |
|||
return ERROR; |
|||
} |
|||
|
|||
pCtrl = pDev->pDrvCtrl; |
|||
|
|||
/* printf("pDev @ %p, pCtrl %p\n", pDev, pCtrl); */ |
|||
|
|||
return pCtrl->write(pDev, cmd, var); |
|||
} |
|||
@ -0,0 +1,23 @@ |
|||
#ifndef __VXB_SM2130_SPI_DEV_H |
|||
#define __VXB_SM2130_SPI_DEV_H |
|||
|
|||
#define SPI_DEV_SM2130 "SM2130" |
|||
|
|||
#define SPI_DEV_MUTEX_OPT \ |
|||
(SEM_Q_PRIORITY | SEM_DELETE_SAFE | SEM_INVERSION_SAFE) |
|||
|
|||
typedef struct _spi_1553b_drv_ctrl { |
|||
VXB_DEVICE_ID pDev; |
|||
|
|||
int cs; |
|||
int mode; |
|||
unsigned int freq; |
|||
|
|||
INT32 (*read)(VXB_DEVICE_ID pDev, UINT8 cmd); |
|||
STATUS (*write)(VXB_DEVICE_ID pDev, UINT8 cmd, UINT16 var); |
|||
|
|||
SEM_ID muteSem; /* operation semaphore */ |
|||
VXB_SPI_MAST_SPEC *specialInfo; |
|||
} SM2130_SPI_DEV; |
|||
|
|||
#endif |
|||
Loading…
Reference in new issue