Trond Enger / d7a_1x

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Fork of d7a_1x by WizziLab

src/d7a_sys.cpp@79:82b01c1a62f6, 2016-12-21 (annotated)

Committer:
Jeej
Date:
Wed Dec 21 15:08:51 2016 +0000
Revision:
79:82b01c1a62f6
Parent:
78:f1c0affd99e7
Child:
83:f4054d0b29ba
Unitary debug prints.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jeej 25:aac250164497 1 #include "mbed.h"
Jeej 25:aac250164497 2 #include "rtos.h"
Jeej 25:aac250164497 3 #include "dbg.h"
Jeej 25:aac250164497 4 #include "d7a_com.h"
Jeej 25:aac250164497 5 #include "d7a_common.h"
Jeej 25:aac250164497 6 #include "d7a_fs.h"
Jeej 25:aac250164497 7 #include "d7a_sys.h"
Jeej 43:28202405094d 8 #include "d7a.h"
Jeej 25:aac250164497 9
Jeej 79:82b01c1a62f6 10 #if 0
Jeej 79:82b01c1a62f6 11 #define SYS_DPRINT(...) DPRINT(__VA_ARGS__)
Jeej 79:82b01c1a62f6 12 #define SYS_DPRINT_DATA(...) DPRINT_DATA(__VA_ARGS__)
Jeej 79:82b01c1a62f6 13 #else
Jeej 79:82b01c1a62f6 14 #define SYS_DPRINT(...);
Jeej 79:82b01c1a62f6 15 #define SYS_DPRINT_DATA(...);
Jeej 79:82b01c1a62f6 16 #endif
Jeej 79:82b01c1a62f6 17
Jeej 78:f1c0affd99e7 18 static Thread g_sys_thread(osPriorityHigh, 512, NULL);
Jeej 77:8c792719a1fc 19 static Queue<d7a_com_rx_msg_t, 8> g_sys_pkt_queue;
Jeej 77:8c792719a1fc 20 static Queue<bool, 1> g_sys_wait_pong;
Jeej 25:aac250164497 21
Jeej 76:fda2e34ff19d 22 void d7a_sys_thread();
Jeej 25:aac250164497 23
Jeej 56:da34fc11e760 24 d7a_errors_t d7a_sys_open(void)
Jeej 25:aac250164497 25 {
Jeej 25:aac250164497 26 FPRINT("\r\n");
Jeej 76:fda2e34ff19d 27
Jeej 77:8c792719a1fc 28 osStatus err = g_sys_thread.start(d7a_sys_thread);
Jeej 76:fda2e34ff19d 29 ASSERT(err == osOK, "Failed to start d7a_sys_thread (err: %d)\r\n", err);
Jeej 49:81d5bddb02f0 30
Jeej 49:81d5bddb02f0 31 return D7A_ERR_NONE;
Jeej 25:aac250164497 32 }
Jeej 25:aac250164497 33
Jeej 56:da34fc11e760 34 d7a_errors_t d7a_sys_close(void)
Jeej 56:da34fc11e760 35 {
Jeej 56:da34fc11e760 36 FPRINT("\r\n");
Jeej 56:da34fc11e760 37
Jeej 77:8c792719a1fc 38 g_sys_thread.terminate();
Jeej 56:da34fc11e760 39
Jeej 56:da34fc11e760 40 return D7A_ERR_NONE;
Jeej 56:da34fc11e760 41 }
Jeej 56:da34fc11e760 42
Jeej 25:aac250164497 43 void d7a_sys_new_pkt(d7a_com_rx_msg_t* pkt)
Jeej 25:aac250164497 44 {
Jeej 25:aac250164497 45 FPRINT("\r\n");
Jeej 77:8c792719a1fc 46 ASSERT(g_sys_pkt_queue.put(pkt) == osOK, "SYS queue full!\r\n");
Jeej 25:aac250164497 47 }
Jeej 25:aac250164497 48
Jeej 25:aac250164497 49 d7a_com_rx_msg_t* d7a_sys_wait_pkt( uint32_t millisec )
Jeej 25:aac250164497 50 {
Jeej 25:aac250164497 51 FPRINT("\r\n");
Jeej 77:8c792719a1fc 52 osEvent evt = g_sys_pkt_queue.get(millisec);
Jeej 25:aac250164497 53 return (evt.status == osEventMessage)? (d7a_com_rx_msg_t*)evt.value.p : NULL;
Jeej 25:aac250164497 54 }
Jeej 25:aac250164497 55
Jeej 28:0376b97b4b55 56 void d7a_sys_tlev(uint8_t mod, uint16_t lev)
Jeej 28:0376b97b4b55 57 {
Jeej 28:0376b97b4b55 58 FPRINT("\r\n");
Jeej 28:0376b97b4b55 59 uint8_t buf[3];
Jeej 30:d775c1409849 60
Jeej 28:0376b97b4b55 61 buf[0] = mod;
Jeej 28:0376b97b4b55 62 buf[1] = (uint8_t)(lev << 8);
Jeej 28:0376b97b4b55 63 buf[2] = (uint8_t)(lev & 0x00FF);
Jeej 30:d775c1409849 64
Jeej 30:d775c1409849 65 d7a_com_dump(buf, 3, KAL_COM_FLOW_SYS_TLEV);
Jeej 28:0376b97b4b55 66 }
Jeej 28:0376b97b4b55 67
Jeej 30:d775c1409849 68 bool d7a_sys_ping_modem(uint32_t millisec)
Jeej 30:d775c1409849 69 {
Jeej 30:d775c1409849 70 FPRINT("\r\n");
Jeej 30:d775c1409849 71 uint8_t buf[5] = "PING";
Jeej 30:d775c1409849 72
Jeej 30:d775c1409849 73 d7a_com_dump(buf, 4, KAL_COM_FLOW_SYS_PING);
Jeej 30:d775c1409849 74
Jeej 77:8c792719a1fc 75 osEvent evt = g_sys_wait_pong.get(millisec);
Jeej 30:d775c1409849 76
Jeej 30:d775c1409849 77 return (evt.status == osEventMessage)? true: false;
Jeej 30:d775c1409849 78 }
Jeej 30:d775c1409849 79
Jeej 30:d775c1409849 80 void d7a_sys_software_reset(void)
Jeej 29:8e7c5c1e9aab 81 {
Jeej 29:8e7c5c1e9aab 82 FPRINT("\r\n");
Jeej 30:d775c1409849 83 uint8_t buf[4] = "RST";
Jeej 30:d775c1409849 84
Jeej 40:b4df548bd9d8 85 d7a_com_dump(buf, 3, KAL_COM_FLOW_SYS_RST);
Jeej 30:d775c1409849 86 }
Jeej 30:d775c1409849 87
Jeej 30:d775c1409849 88 void d7a_sys_button(uint8_t button)
Jeej 30:d775c1409849 89 {
Jeej 30:d775c1409849 90 FPRINT("\r\n");
Jeej 30:d775c1409849 91 button += '0';
Jeej 29:8e7c5c1e9aab 92
Jeej 30:d775c1409849 93 d7a_com_dump(&button, 1, KAL_COM_FLOW_SYS_BUTTON);
Jeej 29:8e7c5c1e9aab 94 }
Jeej 30:d775c1409849 95
Jeej 34:1311cc53201a 96 void d7a_sys_xack(void)
Jeej 34:1311cc53201a 97 {
Jeej 34:1311cc53201a 98 uint8_t buf[] = "X";
Jeej 34:1311cc53201a 99 d7a_com_dump(buf, 1, KAL_COM_FLOW_SYS_XACK);
Jeej 34:1311cc53201a 100 }
Jeej 29:8e7c5c1e9aab 101
Jeej 76:fda2e34ff19d 102 void d7a_sys_thread()
Jeej 25:aac250164497 103 {
Jeej 58:38a366236bda 104 FPRINT("(id:0x%08x)\r\n", osThreadGetId());
Jeej 25:aac250164497 105 d7a_com_rx_msg_t* pkt;
Jeej 25:aac250164497 106
Jeej 25:aac250164497 107 while (true)
Jeej 25:aac250164497 108 {
Jeej 25:aac250164497 109 pkt = d7a_sys_wait_pkt();
Jeej 25:aac250164497 110 ASSERT(pkt != NULL, "SYS NULL pkt\r\n");
Jeej 25:aac250164497 111
Jeej 25:aac250164497 112 switch(pkt->id)
Jeej 25:aac250164497 113 {
Jeej 25:aac250164497 114 case KAL_COM_FLOW_SYS_RST:
Jeej 79:82b01c1a62f6 115 SYS_DPRINT("KAL_COM_FLOW_SYS_RST\r\n");
Jeej 25:aac250164497 116 FLUSH();
Jeej 25:aac250164497 117 NVIC_SystemReset();
Jeej 25:aac250164497 118 break;
Jeej 25:aac250164497 119 case KAL_COM_FLOW_SYS_BUTTON:
Jeej 79:82b01c1a62f6 120 SYS_DPRINT("KAL_COM_FLOW_SYS_BUTTON\r\n");
Jeej 25:aac250164497 121 break;
Jeej 25:aac250164497 122 case KAL_COM_FLOW_SYS_INFO:
Jeej 79:82b01c1a62f6 123 SYS_DPRINT("KAL_COM_FLOW_SYS_INFO\r\n");
Jeej 25:aac250164497 124 break;
Jeej 25:aac250164497 125 case KAL_COM_FLOW_SYS_CUP:
Jeej 79:82b01c1a62f6 126 SYS_DPRINT("KAL_COM_FLOW_SYS_CUP\r\n");
Jeej 25:aac250164497 127 break;
Jeej 25:aac250164497 128 case KAL_COM_FLOW_SYS_PING:
Jeej 79:82b01c1a62f6 129 SYS_DPRINT("KAL_COM_FLOW_SYS_PING\r\n");
Jeej 25:aac250164497 130 uint8_t buf[5] = "PONG";
Jeej 34:1311cc53201a 131 d7a_com_dump(buf, 4, KAL_COM_FLOW_SYS_PONG);
Jeej 25:aac250164497 132 break;
Jeej 25:aac250164497 133 case KAL_COM_FLOW_SYS_PONG:
Jeej 79:82b01c1a62f6 134 SYS_DPRINT("KAL_COM_FLOW_SYS_PONG\r\n");
Jeej 77:8c792719a1fc 135 g_sys_wait_pong.put(NULL);
Jeej 25:aac250164497 136 break;
Jeej 25:aac250164497 137 case KAL_COM_FLOW_SYS_CFG:
Jeej 79:82b01c1a62f6 138 SYS_DPRINT("KAL_COM_FLOW_SYS_CFG\r\n");
Jeej 25:aac250164497 139 break;
Jeej 25:aac250164497 140 case KAL_COM_FLOW_SYS_TLEV:
Jeej 79:82b01c1a62f6 141 SYS_DPRINT("KAL_COM_FLOW_SYS_TLEV\r\n");
Jeej 25:aac250164497 142 break;
Jeej 25:aac250164497 143 case KAL_COM_FLOW_SYS_REDIR:
Jeej 79:82b01c1a62f6 144 SYS_DPRINT("KAL_COM_FLOW_SYS_REDIR\r\n");
Jeej 25:aac250164497 145 break;
Jeej 25:aac250164497 146 default:
Jeej 25:aac250164497 147 EPRINT("SYS Unknown Flow ID 0x%02X\r\n", pkt->id);
Jeej 25:aac250164497 148 break;
Jeej 25:aac250164497 149 }
Jeej 25:aac250164497 150
Jeej 25:aac250164497 151 FREE(pkt);
Jeej 25:aac250164497 152 }
Jeej 25:aac250164497 153 }