diff options
author | Joshua Drake <Joshua.Ellis.Drake@gmail.com> | 2024-04-25 16:59:11 -0500 |
---|---|---|
committer | Joshua Drake <Joshua.Ellis.Drake@gmail.com> | 2024-04-25 16:59:11 -0500 |
commit | a4055061108975b41e34602c29ed2185d8a654d1 (patch) | |
tree | fa1801fabd53a6b00fc972b5c6d1bbd07534fcd2 /SPI.c | |
parent | 319b3a68ee64d8549524b53fba2934e94c07d19e (diff) |
Commit Prior to testing.
Diffstat (limited to 'SPI.c')
-rw-r--r-- | SPI.c | 25 |
1 files changed, 25 insertions, 0 deletions
@@ -39,6 +39,20 @@ //if (Ohm_68 == 5) WriteBuffer[3]|= 0b10000000; readData = MSSP1_SPI_Exchange8bitBuffer(WriteBuffer, 6, ReadBuffer); } + uint8_t active150() + { + WriteBuffer[0] = WriteBuffer[2] = WriteBuffer[4] = 0b01000000; + WriteBuffer[1] = WriteBuffer[3] = WriteBuffer[5] = 0x00; + readData = MSSP1_SPI_Exchange8bitBuffer(WriteBuffer, 6, ReadBuffer); + return (bitcount(ReadBuffer[5]) + bitcount(ReadBuffer[3] << 1)); + } + uint8_t active68() + { + WriteBuffer[0] = WriteBuffer[2] = WriteBuffer[4] = 0b01000000; + WriteBuffer[1] = WriteBuffer[3] = WriteBuffer[5] = 0x00; + readData = MSSP1_SPI_Exchange8bitBuffer(WriteBuffer, 6, ReadBuffer); + return ((ReadBuffer[3] >> 7) + bitcount(ReadBuffer[1] << 1)); + } void Message_BIM(uint8_t outputs[3]) { @@ -161,3 +175,14 @@ WriteBuffer[3] = outputs[1]; WriteBuffer[5] = outputs[2]; } + +uint8_t bitcount(uint8_t n) +{ + uint8_t count = 0; + while (n > 0) + { + count++; + n = n & (n-1); + } + return count; +} |