diff options
| author | edolomb <none@example.com> | 2018-01-15 20:11:08 +0000 |
|---|---|---|
| committer | edolomb <none@example.com> | 2018-01-15 20:11:08 +0000 |
| commit | 9f91962baee1aade5618a66f436bb8f4039b2368 (patch) | |
| tree | f9135aa060a5a48412faf2d8ea9b5c8a45f7bf3d /os/hal/ports/SAMA/SAMA5D2x/sama_matrix.c | |
| parent | b28c62685d857b55dd8bc7e759a9f93ab0a51632 (diff) | |
| download | ChibiOS-9f91962baee1aade5618a66f436bb8f4039b2368.tar.gz ChibiOS-9f91962baee1aade5618a66f436bb8f4039b2368.tar.bz2 ChibiOS-9f91962baee1aade5618a66f436bb8f4039b2368.zip | |
Fixed Bugs
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@11274 35acf78f-673a-0410-8e92-d51de3d6d3f4
Diffstat (limited to 'os/hal/ports/SAMA/SAMA5D2x/sama_matrix.c')
| -rw-r--r-- | os/hal/ports/SAMA/SAMA5D2x/sama_matrix.c | 17 |
1 files changed, 12 insertions, 5 deletions
diff --git a/os/hal/ports/SAMA/SAMA5D2x/sama_matrix.c b/os/hal/ports/SAMA/SAMA5D2x/sama_matrix.c index 27a3544b5..dc187a5ff 100644 --- a/os/hal/ports/SAMA/SAMA5D2x/sama_matrix.c +++ b/os/hal/ports/SAMA/SAMA5D2x/sama_matrix.c @@ -88,19 +88,26 @@ * @retval false Peripheral is secured.
*
*/
-bool mtxConfigPeriphSecurity(Matrix *mtxp, uint8_t id, bool mode) {
+bool mtxConfigPeriphSecurity(Matrix *mtxp, uint32_t id, bool mode) {
+ uint32_t mask;
+ if (id < 74) {
+ mask = id & 0x1F;
+ }
+ else {
+ mask = (id & 0x1F) - 1;
+ }
mtxDisableWP(mtxp);
if (mode) {
- mtxp->MATRIX_SPSELR[id / 32] |= (MATRIX_SPSELR_NSECP0 << id);
+ mtxp->MATRIX_SPSELR[id / 32] |= (MATRIX_SPSELR_NSECP0 << mask);
}
else {
- mtxp->MATRIX_SPSELR[id / 32] &= ~(MATRIX_SPSELR_NSECP0 << id);
+ mtxp->MATRIX_SPSELR[id / 32] &= ~(MATRIX_SPSELR_NSECP0 << mask);
}
mtxEnableWP(mtxp);
- return (MATRIX0->MATRIX_SPSELR[id / 32] & (MATRIX_SPSELR_NSECP0 << id)) &
- (MATRIX1->MATRIX_SPSELR[id / 32] & (MATRIX_SPSELR_NSECP0 << id));
+ return (MATRIX0->MATRIX_SPSELR[id / 32] & (MATRIX_SPSELR_NSECP0 << mask)) &
+ (MATRIX1->MATRIX_SPSELR[id / 32] & (MATRIX_SPSELR_NSECP0 << mask));
}
/**
|