falso
/
tmc
mirror of https://github.com/zeldaret/tmc.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #575 from jeremyherbert/master 

Add WriteBit and ClearBit
This commit is contained in:
notyourav 2022-10-11 17:54:02 -07:00 committed by GitHub
parent c851c7876c f7d002312b
commit 9ef3442fe3
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 20 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

34
src/common.c
View File

@ -106,33 +106,39 @@ u32 ReadBit(void* src, u32 bit) {
return (*((u8*)src + bit / 8) >> (bit % 8)) & 1;
}
NONMATCH("asm/non_matching/common/WriteBit.inc", u32 WriteBit(void* src, u32 bit)) {
u8* b;
u32 WriteBit(void* src, u32 bit) {
u32 b;
u32 mask;
u32 orig;
b = (u8*)(bit / 8 + (u32)src);
mask = 1 << (bit % 8);
orig = *b;
*b |= mask;
// note that the following line relies on undefined behaviour; b is not initialised
b += ((u32)src + bit / 8) - b;
mask = 0x7;
mask = 1 << (bit & mask);
orig = *((u8*)b);
*((u8*)b) |= mask;
orig &= mask;
return orig;
}
END_NONMATCH
NONMATCH("asm/non_matching/common/ClearBit.inc", u32 ClearBit(void* src, u32 bit)) {
u8* b;
u32 ClearBit(void* src, u32 bit) {
u32 b;
u32 mask;
u32 orig;
b = (u8*)(bit / 8 + (u32)src);
mask = 1 << (bit % 8);
orig = *b;
*b &= ~mask;
// note that the following line relies on undefined behaviour; b is not initialised
b += ((u32)src + bit / 8) - b;
mask = 0x7;
mask = 1 << (bit & mask);
orig = *((u8*)b);
*((u8*)b) &= ~mask;
orig &= mask;
return orig;
}
END_NONMATCH
void MemFill16(u32 value, void* dest, u32 size) {
DmaFill16(3, value, dest, size);