root / main.c @ 04b8cd51
History | View | Annotate | Download (1.63 KB)
1 | 20e5429c | Tom Mullins | #include <stdint.h> |
---|---|---|---|
2 | #include <util/delay.h> |
||
3 | #include "mb.h" |
||
4 | #include "mbport.h" |
||
5 | #include "tooltron_mb.h" |
||
6 | 9b2b6d91 | Tom Mullins | #include "rfid.h" |
7 | 20e5429c | Tom Mullins | |
8 | 04b8cd51 | Tom Mullins | eMBErrorCode eMBRegCoilsCB(UCHAR *reg_buf, USHORT addr, USHORT n_coils, |
9 | 20e5429c | Tom Mullins | eMBRegisterMode mode) { |
10 | 04b8cd51 | Tom Mullins | // TODO implement coils
|
11 | 20e5429c | Tom Mullins | if (mode == MB_REG_WRITE) {
|
12 | return MB_ENOREG;
|
||
13 | } else if (mode == MB_REG_READ) { |
||
14 | return MB_ENOREG;
|
||
15 | } else {
|
||
16 | return MB_EIO;
|
||
17 | } |
||
18 | } |
||
19 | |||
20 | 04b8cd51 | Tom Mullins | eMBErrorCode eMBRegDiscreteCB(UCHAR *reg_buf, USHORT addr, USHORT n_coils) { |
21 | 20e5429c | Tom Mullins | return MB_ENOREG;
|
22 | } |
||
23 | |||
24 | 04b8cd51 | Tom Mullins | eMBErrorCode eMBRegInputCB(UCHAR *reg_buf, USHORT addr, USHORT n_regs) { |
25 | char serno[RFID_SERNO_SIZE];
|
||
26 | |||
27 | rfid_get_serno(serno); |
||
28 | |||
29 | 20e5429c | Tom Mullins | switch (addr) {
|
30 | 04b8cd51 | Tom Mullins | |
31 | case MB_INP_SERNOL:
|
||
32 | // TODO check that these (and the ones in SERNOH) are in the right order
|
||
33 | *reg_buf++ = serno[0];
|
||
34 | *reg_buf++ = serno[1];
|
||
35 | n_regs--; |
||
36 | if (n_regs == 0) { |
||
37 | return MB_ENOERR;
|
||
38 | } |
||
39 | |||
40 | case MB_INP_SERNOH:
|
||
41 | *reg_buf++ = serno[2];
|
||
42 | *reg_buf++ = serno[3];
|
||
43 | n_regs--; |
||
44 | if (n_regs == 0) { |
||
45 | return MB_ENOERR;
|
||
46 | } |
||
47 | |||
48 | case MB_INP_CURRENT:
|
||
49 | *reg_buf++ = 0;
|
||
50 | *reg_buf++ = 0;
|
||
51 | n_regs--; |
||
52 | if (n_regs == 0) { |
||
53 | return MB_ENOERR;
|
||
54 | 20e5429c | Tom Mullins | } |
55 | 04b8cd51 | Tom Mullins | |
56 | 20e5429c | Tom Mullins | default:
|
57 | return MB_ENOREG;
|
||
58 | } |
||
59 | } |
||
60 | |||
61 | 04b8cd51 | Tom Mullins | eMBErrorCode eMBRegHoldingCB(UCHAR *reg_buf, USHORT addr, USHORT n_regs, |
62 | 20e5429c | Tom Mullins | eMBRegisterMode mode) { |
63 | if (mode == MB_REG_WRITE) {
|
||
64 | return MB_ENOREG;
|
||
65 | } else if (mode == MB_REG_READ) { |
||
66 | return MB_ENOREG;
|
||
67 | } else {
|
||
68 | return MB_EIO;
|
||
69 | } |
||
70 | } |
||
71 | |||
72 | int main() {
|
||
73 | 9b2b6d91 | Tom Mullins | rfid_init(); |
74 | 20e5429c | Tom Mullins | |
75 | eMBInit(MB_RTU, SLAVE_ADDR, 0, MB_BAUD, MB_PAR_NONE);
|
||
76 | eMBEnable(); |
||
77 | |||
78 | while (1) { |
||
79 | rfid_read(); |
||
80 | eMBPoll(); |
||
81 | _delay_ms(200);
|
||
82 | } |
||
83 | |||
84 | return 0; |
||
85 | } |