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@44:8ebe6b70f932, 2016-08-30 (annotated)

Committer:
Jeej
Date:
Tue Aug 30 17:15:31 2016 +0000
Revision:
44:8ebe6b70f932
Parent:
43:28202405094d
Parent:
40:b4df548bd9d8
Child:
49:81d5bddb02f0
Fuse branches.

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 25:aac250164497 10
Jeej 25:aac250164497 11 typedef struct {
Jeej 25:aac250164497 12 Thread* thread;
Jeej 25:aac250164497 13 Queue<d7a_com_rx_msg_t, 16> pkt_queue;
Jeej 29:8e7c5c1e9aab 14 Queue<bool, 1> wait_pong;
Jeej 25:aac250164497 15 } d7a_sys_ctx_t;
Jeej 25:aac250164497 16
Jeej 25:aac250164497 17 d7a_sys_ctx_t g_sys_ctx;
Jeej 25:aac250164497 18
Jeej 25:aac250164497 19 void d7a_sys_thread(const void *p);
Jeej 25:aac250164497 20
Jeej 25:aac250164497 21 void d7a_sys_open( void )
Jeej 25:aac250164497 22 {
Jeej 25:aac250164497 23 FPRINT("\r\n");
Jeej 34:1311cc53201a 24
Jeej 31:ab9bfdbc6b44 25 g_sys_ctx.thread = new Thread(d7a_sys_thread, NULL, osPriorityHigh, DEFAULT_STACK_SIZE);
Jeej 25:aac250164497 26 }
Jeej 25:aac250164497 27
Jeej 25:aac250164497 28 void d7a_sys_new_pkt(d7a_com_rx_msg_t* pkt)
Jeej 25:aac250164497 29 {
Jeej 25:aac250164497 30 FPRINT("\r\n");
Jeej 25:aac250164497 31 ASSERT(g_sys_ctx.pkt_queue.put(pkt) == osOK, "SYS queue full!\r\n");
Jeej 25:aac250164497 32 }
Jeej 25:aac250164497 33
Jeej 25:aac250164497 34 d7a_com_rx_msg_t* d7a_sys_wait_pkt( uint32_t millisec )
Jeej 25:aac250164497 35 {
Jeej 25:aac250164497 36 FPRINT("\r\n");
Jeej 25:aac250164497 37 osEvent evt = g_sys_ctx.pkt_queue.get(millisec);
Jeej 25:aac250164497 38 return (evt.status == osEventMessage)? (d7a_com_rx_msg_t*)evt.value.p : NULL;
Jeej 25:aac250164497 39 }
Jeej 25:aac250164497 40
Jeej 28:0376b97b4b55 41 void d7a_sys_tlev(uint8_t mod, uint16_t lev)
Jeej 28:0376b97b4b55 42 {
Jeej 28:0376b97b4b55 43 FPRINT("\r\n");
Jeej 28:0376b97b4b55 44 uint8_t buf[3];
Jeej 30:d775c1409849 45
Jeej 28:0376b97b4b55 46 buf[0] = mod;
Jeej 28:0376b97b4b55 47 buf[1] = (uint8_t)(lev << 8);
Jeej 28:0376b97b4b55 48 buf[2] = (uint8_t)(lev & 0x00FF);
Jeej 30:d775c1409849 49
Jeej 30:d775c1409849 50 d7a_com_dump(buf, 3, KAL_COM_FLOW_SYS_TLEV);
Jeej 28:0376b97b4b55 51 }
Jeej 28:0376b97b4b55 52
Jeej 30:d775c1409849 53 bool d7a_sys_ping_modem(uint32_t millisec)
Jeej 30:d775c1409849 54 {
Jeej 30:d775c1409849 55 FPRINT("\r\n");
Jeej 30:d775c1409849 56 uint8_t buf[5] = "PING";
Jeej 30:d775c1409849 57
Jeej 30:d775c1409849 58 d7a_com_dump(buf, 4, KAL_COM_FLOW_SYS_PING);
Jeej 30:d775c1409849 59
Jeej 30:d775c1409849 60 osEvent evt = g_sys_ctx.wait_pong.get(millisec);
Jeej 30:d775c1409849 61
Jeej 30:d775c1409849 62 return (evt.status == osEventMessage)? true: false;
Jeej 30:d775c1409849 63 }
Jeej 30:d775c1409849 64
Jeej 30:d775c1409849 65 void d7a_sys_software_reset(void)
Jeej 29:8e7c5c1e9aab 66 {
Jeej 29:8e7c5c1e9aab 67 FPRINT("\r\n");
Jeej 30:d775c1409849 68 uint8_t buf[4] = "RST";
Jeej 30:d775c1409849 69
Jeej 40:b4df548bd9d8 70 d7a_com_dump(buf, 3, KAL_COM_FLOW_SYS_RST);
Jeej 30:d775c1409849 71 }
Jeej 30:d775c1409849 72
Jeej 30:d775c1409849 73 void d7a_sys_button(uint8_t button)
Jeej 30:d775c1409849 74 {
Jeej 30:d775c1409849 75 FPRINT("\r\n");
Jeej 30:d775c1409849 76 button += '0';
Jeej 29:8e7c5c1e9aab 77
Jeej 30:d775c1409849 78 d7a_com_dump(&button, 1, KAL_COM_FLOW_SYS_BUTTON);
Jeej 29:8e7c5c1e9aab 79 }
Jeej 30:d775c1409849 80
Jeej 34:1311cc53201a 81 void d7a_sys_xack(void)
Jeej 34:1311cc53201a 82 {
Jeej 34:1311cc53201a 83 uint8_t buf[] = "X";
Jeej 34:1311cc53201a 84 d7a_com_dump(buf, 1, KAL_COM_FLOW_SYS_XACK);
Jeej 34:1311cc53201a 85 }
Jeej 29:8e7c5c1e9aab 86
Jeej 25:aac250164497 87 void d7a_sys_thread(const void *p)
Jeej 25:aac250164497 88 {
Jeej 25:aac250164497 89 FPRINT("\r\n");
Jeej 25:aac250164497 90 d7a_com_rx_msg_t* pkt;
Jeej 25:aac250164497 91
Jeej 25:aac250164497 92 while (true)
Jeej 25:aac250164497 93 {
Jeej 25:aac250164497 94 pkt = d7a_sys_wait_pkt();
Jeej 25:aac250164497 95 ASSERT(pkt != NULL, "SYS NULL pkt\r\n");
Jeej 25:aac250164497 96
Jeej 25:aac250164497 97 switch(pkt->id)
Jeej 25:aac250164497 98 {
Jeej 25:aac250164497 99 case KAL_COM_FLOW_SYS_RST:
Jeej 30:d775c1409849 100 IPRINT("KAL_COM_FLOW_SYS_RST\r\n");
Jeej 25:aac250164497 101 FLUSH();
Jeej 25:aac250164497 102 NVIC_SystemReset();
Jeej 25:aac250164497 103 break;
Jeej 25:aac250164497 104 case KAL_COM_FLOW_SYS_BUTTON:
Jeej 30:d775c1409849 105 IPRINT("KAL_COM_FLOW_SYS_BUTTON\r\n");
Jeej 25:aac250164497 106 break;
Jeej 25:aac250164497 107 case KAL_COM_FLOW_SYS_INFO:
Jeej 30:d775c1409849 108 IPRINT("KAL_COM_FLOW_SYS_INFO\r\n");
Jeej 25:aac250164497 109 break;
Jeej 25:aac250164497 110 case KAL_COM_FLOW_SYS_CUP:
Jeej 30:d775c1409849 111 IPRINT("KAL_COM_FLOW_SYS_CUP\r\n");
Jeej 25:aac250164497 112 break;
Jeej 25:aac250164497 113 case KAL_COM_FLOW_SYS_PING:
Jeej 30:d775c1409849 114 IPRINT("KAL_COM_FLOW_SYS_PING\r\n");
Jeej 25:aac250164497 115 uint8_t buf[5] = "PONG";
Jeej 34:1311cc53201a 116 d7a_com_dump(buf, 4, KAL_COM_FLOW_SYS_PONG);
Jeej 25:aac250164497 117 break;
Jeej 25:aac250164497 118 case KAL_COM_FLOW_SYS_PONG:
Jeej 34:1311cc53201a 119 //IPRINT("KAL_COM_FLOW_SYS_PONG\r\n");
Jeej 29:8e7c5c1e9aab 120 g_sys_ctx.wait_pong.put(NULL);
Jeej 25:aac250164497 121 break;
Jeej 25:aac250164497 122 case KAL_COM_FLOW_SYS_CFG:
Jeej 30:d775c1409849 123 IPRINT("KAL_COM_FLOW_SYS_CFG\r\n");
Jeej 25:aac250164497 124 break;
Jeej 25:aac250164497 125 case KAL_COM_FLOW_SYS_TLEV:
Jeej 30:d775c1409849 126 IPRINT("KAL_COM_FLOW_SYS_TLEV\r\n");
Jeej 25:aac250164497 127 break;
Jeej 25:aac250164497 128 case KAL_COM_FLOW_SYS_REDIR:
Jeej 30:d775c1409849 129 IPRINT("KAL_COM_FLOW_SYS_REDIR\r\n");
Jeej 25:aac250164497 130 break;
Jeej 25:aac250164497 131 default:
Jeej 25:aac250164497 132 EPRINT("SYS Unknown Flow ID 0x%02X\r\n", pkt->id);
Jeej 25:aac250164497 133 break;
Jeej 25:aac250164497 134 }
Jeej 25:aac250164497 135
Jeej 25:aac250164497 136 FREE(pkt);
Jeej 25:aac250164497 137 }
Jeej 25:aac250164497 138 }