@@ -94,36 +94,6 @@ static u8_t discover_func(struct bt_conn *conn,
94
94
return BT_GATT_ITER_STOP ;
95
95
}
96
96
97
- static void connected (struct bt_conn * conn , u8_t conn_err )
98
- {
99
- char addr [BT_ADDR_LE_STR_LEN ];
100
- int err ;
101
-
102
- bt_addr_le_to_str (bt_conn_get_dst (conn ), addr , sizeof (addr ));
103
-
104
- if (conn_err ) {
105
- printk ("Failed to connect to %s (%u)\n" , addr , conn_err );
106
- return ;
107
- }
108
-
109
- printk ("Connected: %s\n" , addr );
110
-
111
- if (conn == default_conn ) {
112
- memcpy (& uuid , BT_UUID_HRS , sizeof (uuid ));
113
- discover_params .uuid = & uuid .uuid ;
114
- discover_params .func = discover_func ;
115
- discover_params .start_handle = 0x0001 ;
116
- discover_params .end_handle = 0xffff ;
117
- discover_params .type = BT_GATT_DISCOVER_PRIMARY ;
118
-
119
- err = bt_gatt_discover (default_conn , & discover_params );
120
- if (err ) {
121
- printk ("Discover failed(err %d)\n" , err );
122
- return ;
123
- }
124
- }
125
- }
126
-
127
97
static bool eir_found (struct bt_data * data , void * user_data )
128
98
{
129
99
bt_addr_le_t * addr = user_data ;
@@ -194,13 +164,42 @@ static int scan_start(void)
194
164
return bt_le_scan_start (& scan_param , device_found );
195
165
}
196
166
197
- static void disconnected (struct bt_conn * conn , u8_t reason )
167
+ static void connected (struct bt_conn * conn , u8_t conn_err )
198
168
{
199
169
char addr [BT_ADDR_LE_STR_LEN ];
200
170
int err ;
201
171
202
172
bt_addr_le_to_str (bt_conn_get_dst (conn ), addr , sizeof (addr ));
203
173
174
+ if (conn_err ) {
175
+ printk ("Failed to connect to %s (%u)\n" , addr , conn_err );
176
+ return ;
177
+ }
178
+
179
+ printk ("Connected: %s\n" , addr );
180
+
181
+ if (conn == default_conn ) {
182
+ memcpy (& uuid , BT_UUID_HRS , sizeof (uuid ));
183
+ discover_params .uuid = & uuid .uuid ;
184
+ discover_params .func = discover_func ;
185
+ discover_params .start_handle = 0x0001 ;
186
+ discover_params .end_handle = 0xffff ;
187
+ discover_params .type = BT_GATT_DISCOVER_PRIMARY ;
188
+
189
+ err = bt_gatt_discover (default_conn , & discover_params );
190
+ if (err ) {
191
+ printk ("Discover failed(err %d)\n" , err );
192
+ return ;
193
+ }
194
+ }
195
+ }
196
+
197
+ static void disconnected (struct bt_conn * conn , u8_t reason )
198
+ {
199
+ char addr [BT_ADDR_LE_STR_LEN ];
200
+
201
+ bt_addr_le_to_str (bt_conn_get_dst (conn ), addr , sizeof (addr ));
202
+
204
203
printk ("Disconnected: %s (reason 0x%02x)\n" , addr , reason );
205
204
206
205
if (default_conn != conn ) {
0 commit comments