takayuki ikai / Mbed 2 deprecated BlueWii

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.

Dependencies:   mbed

L2CAP.cpp@0:010465683d59, 2010-12-06 (annotated)

Committer:
ikaii
Date:
Mon Dec 06 17:02:12 2010 +0000
Revision:
0:010465683d59

        

        
Who changed what in which revision?

        

            
                
UserRevisionLine numberNew contents of line

            
            


ikaii

0:010465683d59


     1

/*





ikaii

0:010465683d59


     2

Copyright (c) 2010 Peter Barrett





ikaii

0:010465683d59


     3







ikaii

0:010465683d59


     4

Permission is hereby granted, free of charge, to any person obtaining a copy





ikaii

0:010465683d59


     5

of this software and associated documentation files (the "Software"), to deal





ikaii

0:010465683d59


     6

in the Software without restriction, including without limitation the rights





ikaii

0:010465683d59


     7

to use, copy, modify, merge, publish, distribute, sublicense, and/or sell





ikaii

0:010465683d59


     8

copies of the Software, and to permit persons to whom the Software is





ikaii

0:010465683d59


     9

furnished to do so, subject to the following conditions:





ikaii

0:010465683d59


    10







ikaii

0:010465683d59


    11

The above copyright notice and this permission notice shall be included in





ikaii

0:010465683d59


    12

all copies or substantial portions of the Software.





ikaii

0:010465683d59


    13







ikaii

0:010465683d59


    14

THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR





ikaii

0:010465683d59


    15

IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,





ikaii

0:010465683d59


    16

FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE





ikaii

0:010465683d59


    17

AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER





ikaii

0:010465683d59


    18

LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,





ikaii

0:010465683d59


    19

OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN





ikaii

0:010465683d59


    20

THE SOFTWARE.





ikaii

0:010465683d59


    21

*/





ikaii

0:010465683d59


    22







ikaii

0:010465683d59


    23







ikaii

0:010465683d59


    24

#include <stdio.h>





ikaii

0:010465683d59


    25

#include <stdlib.h>





ikaii

0:010465683d59


    26

#include <stdio.h>





ikaii

0:010465683d59


    27

#include <string.h>





ikaii

0:010465683d59


    28







ikaii

0:010465683d59


    29

#include "Utils.h"





ikaii

0:010465683d59


    30

#include "hci.h"





ikaii

0:010465683d59


    31







ikaii

0:010465683d59


    32

#define L2CAP_COMMAND_REJ       0x01





ikaii

0:010465683d59


    33

#define L2CAP_CONN_REQ          0x02





ikaii

0:010465683d59


    34

#define L2CAP_CONN_RSP          0x03





ikaii

0:010465683d59


    35

#define L2CAP_CONF_REQ          0x04





ikaii

0:010465683d59


    36

#define L2CAP_CONF_RSP          0x05





ikaii

0:010465683d59


    37

#define L2CAP_DISCONN_REQ       0x06





ikaii

0:010465683d59


    38

#define L2CAP_DISCONN_RSP       0x07





ikaii

0:010465683d59


    39

#define L2CAP_ECHO_REQ          0x08





ikaii

0:010465683d59


    40

#define L2CAP_ECHO_RSP          0x09





ikaii

0:010465683d59


    41

#define L2CAP_INFO_REQ          0x0a





ikaii

0:010465683d59


    42

#define L2CAP_INFO_RSP          0x0b





ikaii

0:010465683d59


    43







ikaii

0:010465683d59


    44







ikaii

0:010465683d59


    45

 /* L2CAP command codes */





ikaii

0:010465683d59


    46

 const char* L2CAP_ComandCodeStr(int c)





ikaii

0:010465683d59


    47

 {





ikaii

0:010465683d59


    48

     switch (c)





ikaii

0:010465683d59


    49

     {





ikaii

0:010465683d59


    50

        case L2CAP_COMMAND_REJ:    return "L2CAP_COMMAND_REJ";





ikaii

0:010465683d59


    51

        case L2CAP_CONN_REQ:    return "L2CAP_CONN_REQ";





ikaii

0:010465683d59


    52

        case L2CAP_CONN_RSP:    return "L2CAP_CONN_RSP";





ikaii

0:010465683d59


    53

        case L2CAP_CONF_REQ:    return "L2CAP_CONF_REQ";





ikaii

0:010465683d59


    54

        case L2CAP_CONF_RSP:    return "L2CAP_CONF_RSP";





ikaii

0:010465683d59


    55

        case L2CAP_DISCONN_REQ:    return "L2CAP_DISCONN_REQ";





ikaii

0:010465683d59


    56

        case L2CAP_DISCONN_RSP:    return "L2CAP_DISCONN_RSP";





ikaii

0:010465683d59


    57

        case L2CAP_ECHO_REQ:    return "L2CAP_ECHO_REQ";





ikaii

0:010465683d59


    58

        case L2CAP_ECHO_RSP:    return "L2CAP_ECHO_RSP";





ikaii

0:010465683d59


    59

        case L2CAP_INFO_REQ:    return "L2CAP_INFO_REQ";





ikaii

0:010465683d59


    60

        case L2CAP_INFO_RSP:    return "L2CAP_INFO_RSP";





ikaii

0:010465683d59


    61

     }





ikaii

0:010465683d59


    62

     return "unknown";





ikaii

0:010465683d59


    63

 }





ikaii

0:010465683d59


    64







ikaii

0:010465683d59


    65

typedef struct





ikaii

0:010465683d59


    66

{





ikaii

0:010465683d59


    67

    u16    handle;





ikaii

0:010465683d59


    68

    u16    length;            // total





ikaii

0:010465683d59


    69

    u16    l2capLength;    // length -4





ikaii

0:010465683d59


    70

    u16    cid;            // Signaling packet CID = 1





ikaii

0:010465683d59


    71

    u8  data[64];       // Largest thing to send!!! todo





ikaii

0:010465683d59


    72

} L2CAPData;





ikaii

0:010465683d59


    73







ikaii

0:010465683d59


    74

typedef struct





ikaii

0:010465683d59


    75

{





ikaii

0:010465683d59


    76

    u16    handle;





ikaii

0:010465683d59


    77

    u16    length;            // total





ikaii

0:010465683d59


    78

    u16    l2capLength;    // length -4





ikaii

0:010465683d59


    79

    u16    cid;            // Signaling packet CID = 1





ikaii

0:010465683d59


    80







ikaii

0:010465683d59


    81

    // Payload





ikaii

0:010465683d59


    82

    u8    cmd;            //





ikaii

0:010465683d59


    83

    u8    id;





ikaii

0:010465683d59


    84

    u16    cmdLength;        // total-8





ikaii

0:010465683d59


    85

    u16 params[4];      // Params





ikaii

0:010465683d59


    86

} L2CAPCmd;





ikaii

0:010465683d59


    87







ikaii

0:010465683d59


    88

//





ikaii

0:010465683d59


    89

void BTDevice::Init()





ikaii

0:010465683d59


    90

{





ikaii

0:010465683d59


    91

    memset(&_info,0,sizeof(inquiry_info));





ikaii

0:010465683d59


    92

    _handle = 0;





ikaii

0:010465683d59


    93

    _name[0] = 0;





ikaii

0:010465683d59


    94

    _state = 0;





ikaii

0:010465683d59


    95

}





ikaii

0:010465683d59


    96







ikaii

0:010465683d59


    97

// virtual SocketHandler





ikaii

0:010465683d59


    98

int BTDevice::Open(SocketInternal* sock, SocketAddrHdr* addr)





ikaii

0:010465683d59


    99

{





ikaii

0:010465683d59


   100

    L2CAPSocket* s = (L2CAPSocket*)sock;





ikaii

0:010465683d59


   101

    L2CAPAddr* a = (L2CAPAddr*)addr;





ikaii

0:010465683d59


   102

    s->scid = 0x40 + sock->ID-1;   // are these reserved?





ikaii

0:010465683d59


   103

    s->dcid = 0;





ikaii

0:010465683d59


   104

    Connect(s->scid,a->psm);





ikaii

0:010465683d59


   105

    return sock->ID;





ikaii

0:010465683d59


   106

}





ikaii

0:010465683d59


   107







ikaii

0:010465683d59


   108

// virtual SocketHandler





ikaii

0:010465683d59


   109

int BTDevice::Send(SocketInternal* sock, const u8* data, int len)





ikaii

0:010465683d59


   110

{





ikaii

0:010465683d59


   111

    L2CAPData d;





ikaii

0:010465683d59


   112

    L2CAPSocket* s = (L2CAPSocket*)sock;





ikaii

0:010465683d59


   113







ikaii

0:010465683d59


   114

    d.handle = _handle | 0x2000;





ikaii

0:010465683d59


   115

    d.length = 4 + len;





ikaii

0:010465683d59


   116

    d.l2capLength = len;





ikaii

0:010465683d59


   117

    d.cid = s->dcid;





ikaii

0:010465683d59


   118







ikaii

0:010465683d59


   119

    if (len > 64)





ikaii

0:010465683d59


   120

        return -1;





ikaii

0:010465683d59


   121

    memcpy(d.data,data,len);





ikaii

0:010465683d59


   122

    return Send((u8*)&d,len+8);





ikaii

0:010465683d59


   123

}





ikaii

0:010465683d59


   124







ikaii

0:010465683d59


   125

// virtual SocketHandler





ikaii

0:010465683d59


   126

int BTDevice::Close(SocketInternal* sock)





ikaii

0:010465683d59


   127

{





ikaii

0:010465683d59


   128

    printf("L2CAP close %d\n",sock->ID);





ikaii

0:010465683d59


   129

    L2CAPSocket* s = (L2CAPSocket*)sock;





ikaii

0:010465683d59


   130

    return Disconnect(s->scid,s->dcid);





ikaii

0:010465683d59


   131

}





ikaii

0:010465683d59


   132







ikaii

0:010465683d59


   133

L2CAPSocket* BTDevice::SCIDToSocket(int scid)





ikaii

0:010465683d59


   134

{





ikaii

0:010465683d59


   135

    return (L2CAPSocket*)GetSocketInternal(scid-0x40+1);





ikaii

0:010465683d59


   136

}





ikaii

0:010465683d59


   137







ikaii

0:010465683d59


   138

int BTDevice::Send(const u8* data, int len)





ikaii

0:010465683d59


   139

{





ikaii

0:010465683d59


   140

     _transport->ACLSend(data,len);





ikaii

0:010465683d59


   141

     return 0;





ikaii

0:010465683d59


   142

}





ikaii

0:010465683d59


   143







ikaii

0:010465683d59


   144

int BTDevice::Send(u8 c, u8 id, u16* params, int count)





ikaii

0:010465683d59


   145

{





ikaii

0:010465683d59


   146

    L2CAPCmd cmd;





ikaii

0:010465683d59


   147

    cmd.handle = _handle | 0x2000;





ikaii

0:010465683d59


   148

    cmd.length = 8 + count*2;





ikaii

0:010465683d59


   149







ikaii

0:010465683d59


   150

    cmd.l2capLength = cmd.length-4;





ikaii

0:010465683d59


   151

    cmd.cid = 1;    // Signaling packet





ikaii

0:010465683d59


   152







ikaii

0:010465683d59


   153

    cmd.cmd = c;





ikaii

0:010465683d59


   154

    cmd.id = id;





ikaii

0:010465683d59


   155

    cmd.cmdLength = count*2;





ikaii

0:010465683d59


   156

    for (int i = 0; i < count; i++)





ikaii

0:010465683d59


   157

        cmd.params[i] = params[i];





ikaii

0:010465683d59


   158

    return Send((u8*)&cmd,cmd.length+4);





ikaii

0:010465683d59


   159

}





ikaii

0:010465683d59


   160







ikaii

0:010465683d59


   161

int BTDevice::Connect(int scid, int psm)





ikaii

0:010465683d59


   162

{





ikaii

0:010465683d59


   163

    u16 p[2];





ikaii

0:010465683d59


   164

    p[0] = psm;





ikaii

0:010465683d59


   165

    p[1] = scid;





ikaii

0:010465683d59


   166

    return Send(L2CAP_CONN_REQ,_txid++,p,2);





ikaii

0:010465683d59


   167

}





ikaii

0:010465683d59


   168







ikaii

0:010465683d59


   169

int BTDevice::Disconnect(int scid, int dcid)





ikaii

0:010465683d59


   170

{





ikaii

0:010465683d59


   171

    u16 p[2];





ikaii

0:010465683d59


   172

    p[0] = dcid;





ikaii

0:010465683d59


   173

    p[1] = scid;





ikaii

0:010465683d59


   174

    return Send(L2CAP_DISCONN_REQ,_txid++,p,2);





ikaii

0:010465683d59


   175

}





ikaii

0:010465683d59


   176







ikaii

0:010465683d59


   177

int BTDevice::ConfigureRequest(int dcid)





ikaii

0:010465683d59


   178

{





ikaii

0:010465683d59


   179

    u16 p[4];





ikaii

0:010465683d59


   180

    p[0] = dcid;





ikaii

0:010465683d59


   181

    p[1] = 0;





ikaii

0:010465683d59


   182

    p[2] = 0x0201;  // Options





ikaii

0:010465683d59


   183

    p[3] = 0x02A0;  // 672





ikaii

0:010465683d59


   184

    return Send(L2CAP_CONF_REQ,_txid++,p,4);





ikaii

0:010465683d59


   185

}





ikaii

0:010465683d59


   186







ikaii

0:010465683d59


   187

int BTDevice::ConfigureResponse(u8 rxid, int dcid)





ikaii

0:010465683d59


   188

{





ikaii

0:010465683d59


   189

    u16 p[3];





ikaii

0:010465683d59


   190

    p[0] = dcid;





ikaii

0:010465683d59


   191

    p[1] = 0;





ikaii

0:010465683d59


   192

    p[2] = 0;





ikaii

0:010465683d59


   193

    return Send(L2CAP_CONF_RSP,rxid,p,3);





ikaii

0:010465683d59


   194

}





ikaii

0:010465683d59


   195







ikaii

0:010465683d59


   196

int BTDevice::DisconnectResponse(u8 rxid, int scid, int dcid)





ikaii

0:010465683d59


   197

{





ikaii

0:010465683d59


   198

    u16 p[2];





ikaii

0:010465683d59


   199

    p[0] = dcid;





ikaii

0:010465683d59


   200

    p[1] = scid;





ikaii

0:010465683d59


   201

    return Send(L2CAP_DISCONN_RSP,rxid,p,2);





ikaii

0:010465683d59


   202

}





ikaii

0:010465683d59


   203







ikaii

0:010465683d59


   204

void BTDevice::Control(const u8* data, int len)





ikaii

0:010465683d59


   205

{





ikaii

0:010465683d59


   206

    int cc = data[8];





ikaii

0:010465683d59


   207

    printf(L2CAP_ComandCodeStr(cc));





ikaii

0:010465683d59


   208

    int result = LE16(data+16);





ikaii

0:010465683d59


   209

    printf(" Result %d\n",result);





ikaii

0:010465683d59


   210

    switch (cc)





ikaii

0:010465683d59


   211

    {





ikaii

0:010465683d59


   212

        case L2CAP_COMMAND_REJ:





ikaii

0:010465683d59


   213

           break;





ikaii

0:010465683d59


   214

        case L2CAP_CONN_REQ:





ikaii

0:010465683d59


   215

            break;





ikaii

0:010465683d59


   216







ikaii

0:010465683d59


   217

        // Response to our initial connect from Remote





ikaii

0:010465683d59


   218

        case L2CAP_CONN_RSP:





ikaii

0:010465683d59


   219

            {





ikaii

0:010465683d59


   220

                if (result == 0)





ikaii

0:010465683d59


   221

                {





ikaii

0:010465683d59


   222

                    int dcid = LE16(data+12);





ikaii

0:010465683d59


   223

                    int scid = LE16(data+14);





ikaii

0:010465683d59


   224

                    L2CAPSocket* s = SCIDToSocket(scid);





ikaii

0:010465683d59


   225

                    if (s)





ikaii

0:010465683d59


   226

                    {





ikaii

0:010465683d59


   227

                        s->dcid = dcid;





ikaii

0:010465683d59


   228

                        ConfigureRequest(dcid);





ikaii

0:010465683d59


   229

                    }





ikaii

0:010465683d59


   230

                } else





ikaii

0:010465683d59


   231

                    printf("Connect failed?\n");





ikaii

0:010465683d59


   232

            }





ikaii

0:010465683d59


   233

            break;





ikaii

0:010465683d59


   234







ikaii

0:010465683d59


   235

        case L2CAP_CONF_RSP:





ikaii

0:010465683d59


   236

            {





ikaii

0:010465683d59


   237

                int scid = LE16(data+12);





ikaii

0:010465683d59


   238

                SocketInternal* s = (SocketInternal*)SCIDToSocket(scid);





ikaii

0:010465683d59


   239

                if (s)





ikaii

0:010465683d59


   240

                    s->SetState(SocketState_Open);





ikaii

0:010465683d59


   241

            }





ikaii

0:010465683d59


   242

            break;





ikaii

0:010465683d59


   243







ikaii

0:010465683d59


   244

        case L2CAP_CONF_REQ:





ikaii

0:010465683d59


   245

            {





ikaii

0:010465683d59


   246

                int scid = LE16(data+12);





ikaii

0:010465683d59


   247

                L2CAPSocket* s = SCIDToSocket(scid);





ikaii

0:010465683d59


   248

                if (s)





ikaii

0:010465683d59


   249

                    ConfigureResponse(data[9],s->dcid);





ikaii

0:010465683d59


   250

            }





ikaii

0:010465683d59


   251

            break;





ikaii

0:010465683d59


   252

    }





ikaii

0:010465683d59


   253

}





ikaii

0:010465683d59


   254







ikaii

0:010465683d59


   255

void BTDevice::ACLRecv(const u8* data, int len)





ikaii

0:010465683d59


   256

{





ikaii

0:010465683d59


   257

   // printfBytes("L2CP",data,16);





ikaii

0:010465683d59


   258

    int handle = LE16(data);





ikaii

0:010465683d59


   259

    if (handle != (0x2000 | _handle))





ikaii

0:010465683d59


   260

        return;





ikaii

0:010465683d59


   261







ikaii

0:010465683d59


   262

    int cid = LE16(data+6);





ikaii

0:010465683d59


   263

    if (cid == 1)





ikaii

0:010465683d59


   264

    {





ikaii

0:010465683d59


   265

        Control(data,len);





ikaii

0:010465683d59


   266

        return;





ikaii

0:010465683d59


   267

    }





ikaii

0:010465683d59


   268







ikaii

0:010465683d59


   269

    SocketInternal* s = (SocketInternal*)SCIDToSocket(cid);





ikaii

0:010465683d59


   270

    if (s)





ikaii

0:010465683d59


   271

        s->Recv(data+8,LE16(data+2)-4);





ikaii

0:010465683d59


   272

    else





ikaii

0:010465683d59


   273

        printf("Bad event cid %d\n",cid);





ikaii

0:010465683d59


   274

}