Takashi Matsuoka
/
MJ_AS5040_TEST
Encoder IC AS5040 test program.
main.cpp
- Committer:
- matsujirushi
- Date:
- 2014-10-08
- Revision:
- 1:22538ea9c2ba
- Parent:
- 0:0ace6ddff9f1
File content as of revision 1:22538ea9c2ba:
#include "mbed.h" Serial pc(USBTX, USBRX); DigitalOut CSn(dp28); DigitalOut CLK(dp26); DigitalIn DO(dp25); int main() { // Initial. CSn = 1; CLK = 1; pc.baud(115200); pc.printf("Ready.\r\n"); for (;;) { CSn = 0; wait_us(1); uint16_t data = 0; for (int i = 0; i < 16; i++) { CLK = 0; wait_us(1); CLK = 1; wait_us(1); data <<= 1; if (DO.read()) data |= 1; } CSn = 1; uint16_t angular = data >> 6; uint16_t status = (data >> 1) & 0x1f; pc.printf("%03x %02x\r\n", angular, status); wait(0.2); } }