Simons Wii controlled m3pi program

Dependencies:   mbed m3pi ID12RFIDIRQ

Committer:
chris
Date:
Wed May 18 14:50:46 2011 +0000
Revision:
0:0ab65a1aef12
Added some printing to the m3pi screen

Who changed what in which revision?

UserRevisionLine numberNew contents of line
chris 0:0ab65a1aef12 1 /*
chris 0:0ab65a1aef12 2 Copyright (c) 2010 Peter Barrett
chris 0:0ab65a1aef12 3
chris 0:0ab65a1aef12 4 Permission is hereby granted, free of charge, to any person obtaining a copy
chris 0:0ab65a1aef12 5 of this software and associated documentation files (the "Software"), to deal
chris 0:0ab65a1aef12 6 in the Software without restriction, including without limitation the rights
chris 0:0ab65a1aef12 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
chris 0:0ab65a1aef12 8 copies of the Software, and to permit persons to whom the Software is
chris 0:0ab65a1aef12 9 furnished to do so, subject to the following conditions:
chris 0:0ab65a1aef12 10
chris 0:0ab65a1aef12 11 The above copyright notice and this permission notice shall be included in
chris 0:0ab65a1aef12 12 all copies or substantial portions of the Software.
chris 0:0ab65a1aef12 13
chris 0:0ab65a1aef12 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
chris 0:0ab65a1aef12 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
chris 0:0ab65a1aef12 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
chris 0:0ab65a1aef12 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
chris 0:0ab65a1aef12 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
chris 0:0ab65a1aef12 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
chris 0:0ab65a1aef12 20 THE SOFTWARE.
chris 0:0ab65a1aef12 21 */
chris 0:0ab65a1aef12 22
chris 0:0ab65a1aef12 23 #include <stdio.h>
chris 0:0ab65a1aef12 24 #include <stdlib.h>
chris 0:0ab65a1aef12 25 #include <stdio.h>
chris 0:0ab65a1aef12 26 #include <string.h>
chris 0:0ab65a1aef12 27
chris 0:0ab65a1aef12 28 #include "Utils.h"
chris 0:0ab65a1aef12 29 #include "Socket.h"
chris 0:0ab65a1aef12 30
chris 0:0ab65a1aef12 31 #define MAX_SOCKET_HANDLERS 3
chris 0:0ab65a1aef12 32 #define MAX_SOCKETS 16
chris 0:0ab65a1aef12 33
chris 0:0ab65a1aef12 34 class SocketInternalPad
chris 0:0ab65a1aef12 35 {
chris 0:0ab65a1aef12 36 public:
chris 0:0ab65a1aef12 37 SocketInternal si;
chris 0:0ab65a1aef12 38 u8 pad[8];
chris 0:0ab65a1aef12 39 };
chris 0:0ab65a1aef12 40
chris 0:0ab65a1aef12 41 class SocketManager
chris 0:0ab65a1aef12 42 {
chris 0:0ab65a1aef12 43 SocketHandler* _handlers[MAX_SOCKET_HANDLERS];
chris 0:0ab65a1aef12 44 SocketInternalPad _sockets[MAX_SOCKETS];
chris 0:0ab65a1aef12 45
chris 0:0ab65a1aef12 46 public:
chris 0:0ab65a1aef12 47 SocketManager()
chris 0:0ab65a1aef12 48 {
chris 0:0ab65a1aef12 49 memset(_handlers,0,sizeof(_handlers));
chris 0:0ab65a1aef12 50 memset(_sockets,0,sizeof(_sockets));
chris 0:0ab65a1aef12 51 }
chris 0:0ab65a1aef12 52
chris 0:0ab65a1aef12 53 SocketHandler* GetHandler(int type)
chris 0:0ab65a1aef12 54 {
chris 0:0ab65a1aef12 55 if (type < 1 || type > MAX_SOCKET_HANDLERS)
chris 0:0ab65a1aef12 56 return 0;
chris 0:0ab65a1aef12 57 return _handlers[type - 1];
chris 0:0ab65a1aef12 58 }
chris 0:0ab65a1aef12 59
chris 0:0ab65a1aef12 60 SocketInternal* GetInternal(int s)
chris 0:0ab65a1aef12 61 {
chris 0:0ab65a1aef12 62 if (s < 1 || s > MAX_SOCKETS)
chris 0:0ab65a1aef12 63 return 0;
chris 0:0ab65a1aef12 64 return &_sockets[s - 1].si;
chris 0:0ab65a1aef12 65 }
chris 0:0ab65a1aef12 66
chris 0:0ab65a1aef12 67 int RegisterSocketHandler(int type, SocketHandler* handler)
chris 0:0ab65a1aef12 68 {
chris 0:0ab65a1aef12 69 if (type < 1 || type > MAX_SOCKET_HANDLERS)
chris 0:0ab65a1aef12 70 return ERR_SOCKET_TYPE_NOT_FOUND;
chris 0:0ab65a1aef12 71 _handlers[type - 1] = handler;
chris 0:0ab65a1aef12 72 return 0;
chris 0:0ab65a1aef12 73 }
chris 0:0ab65a1aef12 74
chris 0:0ab65a1aef12 75 int Open(int type, SocketAddrHdr* addr, SocketCallback callback, void* userData)
chris 0:0ab65a1aef12 76 {
chris 0:0ab65a1aef12 77 SocketHandler* h = GetHandler(type);
chris 0:0ab65a1aef12 78 if (!h)
chris 0:0ab65a1aef12 79 return ERR_SOCKET_TYPE_NOT_FOUND;
chris 0:0ab65a1aef12 80
chris 0:0ab65a1aef12 81 for (int i = 0; i < MAX_SOCKETS; i++)
chris 0:0ab65a1aef12 82 {
chris 0:0ab65a1aef12 83 SocketInternal* si = (SocketInternal*)(_sockets+i);
chris 0:0ab65a1aef12 84 if (si->ID == 0)
chris 0:0ab65a1aef12 85 {
chris 0:0ab65a1aef12 86 si->ID = i+1;
chris 0:0ab65a1aef12 87 si->Type = type;
chris 0:0ab65a1aef12 88 si->Callback = callback;
chris 0:0ab65a1aef12 89 si->userData = userData;
chris 0:0ab65a1aef12 90 return h->Open(si,addr);
chris 0:0ab65a1aef12 91 }
chris 0:0ab65a1aef12 92 }
chris 0:0ab65a1aef12 93 return ERR_SOCKET_NONE_LEFT;
chris 0:0ab65a1aef12 94 }
chris 0:0ab65a1aef12 95
chris 0:0ab65a1aef12 96 int Send(int socket, const u8* data, int len)
chris 0:0ab65a1aef12 97 {
chris 0:0ab65a1aef12 98 SocketInternal* si = GetInternal(socket);
chris 0:0ab65a1aef12 99 if (!si || si->ID != socket)
chris 0:0ab65a1aef12 100 return ERR_SOCKET_NOT_FOUND;
chris 0:0ab65a1aef12 101 return GetHandler(si->Type)->Send(si,data,len);
chris 0:0ab65a1aef12 102 }
chris 0:0ab65a1aef12 103
chris 0:0ab65a1aef12 104 int Close(int socket)
chris 0:0ab65a1aef12 105 {
chris 0:0ab65a1aef12 106 SocketInternal* si = GetInternal(socket);
chris 0:0ab65a1aef12 107 if (!si || si->ID != socket)
chris 0:0ab65a1aef12 108 return ERR_SOCKET_NOT_FOUND;
chris 0:0ab65a1aef12 109 si->ID = 0;
chris 0:0ab65a1aef12 110 return GetHandler(si->Type)->Close(si);
chris 0:0ab65a1aef12 111 }
chris 0:0ab65a1aef12 112 };
chris 0:0ab65a1aef12 113
chris 0:0ab65a1aef12 114 SocketManager gSocketManager;
chris 0:0ab65a1aef12 115
chris 0:0ab65a1aef12 116 int Socket_Open(int type, SocketAddrHdr* addr, SocketCallback callback, void* userData)
chris 0:0ab65a1aef12 117 {
chris 0:0ab65a1aef12 118 return gSocketManager.Open(type,addr,callback,userData);
chris 0:0ab65a1aef12 119 }
chris 0:0ab65a1aef12 120
chris 0:0ab65a1aef12 121 int Socket_Send(int socket, const u8* data, int len)
chris 0:0ab65a1aef12 122 {
chris 0:0ab65a1aef12 123 return gSocketManager.Send(socket,data,len);
chris 0:0ab65a1aef12 124 }
chris 0:0ab65a1aef12 125
chris 0:0ab65a1aef12 126 int Socket_Close(int socket)
chris 0:0ab65a1aef12 127 {
chris 0:0ab65a1aef12 128 return gSocketManager.Close(socket);
chris 0:0ab65a1aef12 129 }
chris 0:0ab65a1aef12 130
chris 0:0ab65a1aef12 131 int RegisterSocketHandler(int type, SocketHandler* handler)
chris 0:0ab65a1aef12 132 {
chris 0:0ab65a1aef12 133 return gSocketManager.RegisterSocketHandler(type,handler);
chris 0:0ab65a1aef12 134 }
chris 0:0ab65a1aef12 135
chris 0:0ab65a1aef12 136 SocketInternal* GetSocketInternal(int socket)
chris 0:0ab65a1aef12 137 {
chris 0:0ab65a1aef12 138 return gSocketManager.GetInternal(socket);
chris 0:0ab65a1aef12 139 }
chris 0:0ab65a1aef12 140