-
Notifications
You must be signed in to change notification settings - Fork 0
/
LinkManagement.c
133 lines (109 loc) · 4.11 KB
/
LinkManagement.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
/*
LUFA Powered Wireless 3G Modem Host
Copyright (C) Mike Alexander, 2010.
Copyright (C) Dean Camera, 2010.
*/
/*
Copyright 2010 Mike Alexander (mike [at] mikealex [dot] com)
Copyright 2010 Dean Camera (dean [at] fourwalledcubicle [dot] com)
Permission to use, copy, modify, distribute, and sell this
software and its documentation for any purpose is hereby granted
without fee, provided that the above copyright notice appear in
all copies and that both that the copyright notice and this
permission notice and warranty disclaimer appear in supporting
documentation, and that the name of the author not be used in
advertising or publicity pertaining to distribution of the
software without specific, written prior permission.
The author disclaim all warranties with regard to this
software, including all implied warranties of merchantability
and fitness. In no event shall the author be liable for any
special, indirect or consequential damages or any damages
whatsoever resulting from loss of use, data or profits, whether
in an action of contract, negligence or other tortious action,
arising out of or in connection with the use or performance of
this software.
*/
#define INCLUDE_FROM_LINKMANAGEMENT_C
#include "LinkManagement.h"
uint8_t ConnectedState;
static uint8_t DialSteps;
void LinkManagement_ManageConnectionState(void)
{
switch (ConnectedState)
{
case LINKMANAGEMENT_STATE_Idle:
SystemTicks = 0;
DialSteps = 0;
PPP_InitPPP();
ConnectedState = LINKMANAGEMENT_STATE_SendModemDialCommands;
break;
case LINKMANAGEMENT_STATE_SendModemDialCommands:
if (LinkManagement_DialConnection(ModemDialCommands))
ConnectedState = LINKMANAGEMENT_STATE_SendNetworkDialCommands;
break;
case LINKMANAGEMENT_STATE_SendNetworkDialCommands:
if (LinkManagement_DialConnection(NetworkDialCommands))
{
Debug_Print("Starting PPP\r\n");
PPP_StartLink();
ConnectedState = LINKMANAGEMENT_STATE_WaitForLink;
}
break;
case LINKMANAGEMENT_STATE_WaitForLink:
PPP_ManageLink();
break;
case LINKMANAGEMENT_STATE_InitializeTCPStack:
PPP_ManageLink();
TCPIP_InitializeTCPStack();
break;
case LINKMANAGEMENT_STATE_ConnectToRemoteHost:
PPP_ManageLink();
TCPIP_ConnectToRemoteHost();
break;
case LINKMANAGEMENT_STATE_ManageTCPConnection:
PPP_ManageLink();
TCPIP_TCPIPTask();
break;
}
}
// Read the dial commands and send them to the modem. Wait for the expected response then move on to the next command.
// Returns true if the last dial command has been processed.
static bool LinkManagement_DialConnection(const char** DialCommands)
{
static char* ResponsePtr = NULL;
char* CommandPtr = NULL;
static uint8_t CharsMatched = 0;
char c;
if (USB_HostState != HOST_STATE_Configured)
return false;
while (!RingBuffer_IsEmpty(&Modem_ReceiveBuffer)) // Read back the response
{
c = RingBuffer_Remove(&Modem_ReceiveBuffer);
Debug_PrintChar(c);
if (c == *(ResponsePtr + CharsMatched)) // Match the response character by character with the expected response
CharsMatched++;
else
CharsMatched = 0;
if (CharsMatched != 0 && CharsMatched == strlen(ResponsePtr)) // Look for the expected response
{
DialSteps += 2; // Move on to the next dial command
CharsMatched = 0;
}
}
if (SystemTicks > 100) // Space each command by 1 second
{
CommandPtr = (char*)DialCommands[DialSteps];
ResponsePtr = (char*)DialCommands[DialSteps + 1];
if (CommandPtr == NULL || ResponsePtr == NULL) // No more dial commands
{
DialSteps = 0;
return true; // Finished dialling
}
SystemTicks = 0;
Debug_Print("Send: "); Debug_Print(CommandPtr);
Debug_Print("(Expect: "); Debug_Print(ResponsePtr); Debug_Print(")\r\n");
while (*CommandPtr)
RingBuffer_Insert(&Modem_SendBuffer, *(CommandPtr++)); // Send the command to the modem
}
return false; // Haven't finished dialling
}