[PATCH 9/9] P2P: Update peer listen channel from probe requests

[Ilan Peer]

In case that a probe request is received from a known peer P2P
Device update the listen channel based on the P2P attributes in
the probe request. This can be useful for cases where the peer P2P
Device changed its listen channel, and the local P2P device is about
to start a GoN or invitation signaling with the peer.

Signed-off-by: Ilan Peer <ilan.peer at intel.com>
---
 src/p2p/p2p.c | 19 +++++++++++++++++--
 1 file changed, 17 insertions(+), 2 deletions(-)

diff --git a/src/p2p/p2p.c b/src/p2p/p2p.c
index d28b4cd..fc7cf31 100644
--- a/src/p2p/p2p.c
+++ b/src/p2p/p2p.c
@@ -2034,8 +2034,23 @@ static void p2p_add_dev_from_probe_req(struct p2p_data *p2p, const u8 *addr,
 
 	dev = p2p_get_device(p2p, addr);
 	if (dev) {
-		if (dev->country[0] == 0 && msg.listen_channel)
-			os_memcpy(dev->country, msg.listen_channel, 3);
+		if (msg.listen_channel) {
+			int freq;
+
+			if (dev->country[0] == 0)
+				os_memcpy(dev->country, msg.listen_channel, 3);
+
+			freq = p2p_channel_to_freq(msg.listen_channel[3],
+						   msg.listen_channel[4]);
+
+			if (freq > 0 && dev->listen_freq != freq) {
+				p2p_dbg(p2p,
+					"Listen channel " MACSTR " changed (Probe Req): %d->%d",
+					MAC2STR(addr), dev->listen_freq, freq);
+				dev->listen_freq = freq;
+			}
+		}
+
 		os_get_reltime(&dev->last_seen);
 		p2p_parse_free(&msg);
 		return; /* already known */
-- 
1.9.1