| // Copyright (c) 2012 The Chromium OS Authors. All rights reserved. |
| // Use of this source code is governed by a BSD-style license that can be |
| // found in the LICENSE file. |
| |
| #include "shill/config80211.h" |
| |
| #include <ctype.h> |
| #include <netlink/msg.h> |
| |
| #include <map> |
| #include <sstream> |
| #include <string> |
| |
| #include <base/memory/weak_ptr.h> |
| #include <base/stl_util.h> |
| |
| #include "shill/error.h" |
| #include "shill/io_handler.h" |
| #include "shill/logging.h" |
| #include "shill/nl80211_message.h" |
| #include "shill/nl80211_socket.h" |
| #include "shill/scope_logger.h" |
| |
| using base::Bind; |
| using base::LazyInstance; |
| using std::list; |
| using std::string; |
| |
| namespace shill { |
| |
| namespace { |
| LazyInstance<Config80211> g_config80211 = LAZY_INSTANCE_INITIALIZER; |
| } // namespace |
| |
| Config80211::EventTypeStrings *Config80211::event_types_ = NULL; |
| |
| Config80211::Config80211() |
| : wifi_state_(kWifiDown), |
| dispatcher_(NULL), |
| weak_ptr_factory_(this), |
| dispatcher_callback_(Bind(&Config80211::OnRawNlMessageReceived, |
| weak_ptr_factory_.GetWeakPtr())), |
| sock_(NULL) { |
| } |
| |
| Config80211::~Config80211() { |
| // Since Config80211 is a singleton, it should be safe to delete a static |
| // member. |
| delete event_types_; |
| event_types_ = NULL; |
| } |
| |
| Config80211 *Config80211::GetInstance() { |
| return g_config80211.Pointer(); |
| } |
| |
| void Config80211::Reset() { |
| wifi_state_ = kWifiDown; |
| subscribed_events_.clear(); |
| ClearBroadcastCallbacks(); |
| } |
| |
| bool Config80211::Init(EventDispatcher *dispatcher) { |
| if (!sock_) { |
| sock_ = new Nl80211Socket; |
| if (!sock_) { |
| LOG(ERROR) << "No memory"; |
| return false; |
| } |
| |
| if (!sock_->Init()) { |
| return false; |
| } |
| // Don't make libnl do the sequence checking (because it'll not like |
| // the broadcast messages for which we'll eventually ask). We'll do all the |
| // sequence checking we need. |
| sock_->DisableSequenceChecking(); |
| } |
| |
| if (!event_types_) { |
| event_types_ = new EventTypeStrings; |
| (*event_types_)[Config80211::kEventTypeConfig] = "config"; |
| (*event_types_)[Config80211::kEventTypeScan] = "scan"; |
| (*event_types_)[Config80211::kEventTypeRegulatory] = "regulatory"; |
| (*event_types_)[Config80211::kEventTypeMlme] = "mlme"; |
| } |
| |
| dispatcher_ = dispatcher; |
| return true; |
| } |
| |
| bool Config80211::AddBroadcastCallback(const Callback &callback) { |
| list<Callback>::iterator i; |
| if (FindBroadcastCallback(callback)) { |
| LOG(WARNING) << "Trying to re-add a callback"; |
| return false; // Should only be one copy in the list. |
| } |
| if (callback.is_null()) { |
| LOG(WARNING) << "Trying to add a NULL callback"; |
| return false; |
| } |
| // And add the callback to the list. |
| SLOG(WiFi, 3) << "Config80211::" << __func__ << " - adding callback"; |
| broadcast_callbacks_.push_back(callback); |
| return true; |
| } |
| |
| bool Config80211::RemoveBroadcastCallback(const Callback &callback) { |
| list<Callback>::iterator i; |
| for (i = broadcast_callbacks_.begin(); i != broadcast_callbacks_.end(); ++i) { |
| if ((*i).Equals(callback)) { |
| broadcast_callbacks_.erase(i); |
| // Should only be one copy in the list so we don't have to continue |
| // looking for another one. |
| return true; |
| } |
| } |
| LOG(WARNING) << "Callback not found."; |
| return false; |
| } |
| |
| bool Config80211::FindBroadcastCallback(const Callback &callback) const { |
| list<Callback>::const_iterator i; |
| for (i = broadcast_callbacks_.begin(); i != broadcast_callbacks_.end(); ++i) { |
| if ((*i).Equals(callback)) { |
| return true; |
| } |
| } |
| return false; |
| } |
| |
| void Config80211::ClearBroadcastCallbacks() { |
| broadcast_callbacks_.clear(); |
| } |
| |
| bool Config80211::SendMessage(Nl80211Message *message, |
| const Callback &callback) { |
| if (!message) { |
| LOG(ERROR) << "Message is NULL."; |
| return false; |
| } |
| uint32 sequence_number = message->sequence_number(); |
| if (!sequence_number) { |
| sequence_number = sock_->GetSequenceNumber(); |
| message->set_sequence_number(sequence_number); |
| } |
| if (!sock_->SendMessage(message)) { |
| LOG(ERROR) << "Failed to send nl80211 message."; |
| return false; |
| } |
| if (callback.is_null()) { |
| LOG(INFO) << "Callback for message was null."; |
| return true; |
| } |
| if (ContainsKey(message_callbacks_, sequence_number)) { |
| LOG(ERROR) << "Sent message, but already had a callback for this message?"; |
| return false; |
| } |
| message_callbacks_[sequence_number] = callback; |
| LOG(INFO) << "Sent nl80211 message with sequence number: " << sequence_number; |
| return true; |
| } |
| |
| bool Config80211::RemoveMessageCallback(const Nl80211Message &message) { |
| if (!ContainsKey(message_callbacks_, message.sequence_number())) { |
| return false; |
| } |
| message_callbacks_.erase(message.sequence_number()); |
| return true; |
| } |
| |
| // static |
| bool Config80211::GetEventTypeString(EventType type, string *value) { |
| if (!value) { |
| LOG(ERROR) << "NULL |value|"; |
| return false; |
| } |
| if (!event_types_) { |
| LOG(ERROR) << "NULL |event_types_|"; |
| return false; |
| } |
| |
| EventTypeStrings::iterator match = (*event_types_).find(type); |
| if (match == (*event_types_).end()) { |
| LOG(ERROR) << "Event type " << type << " not found"; |
| return false; |
| } |
| *value = match->second; |
| return true; |
| } |
| |
| void Config80211::SetWifiState(WifiState new_state) { |
| if (wifi_state_ == new_state) { |
| return; |
| } |
| |
| if (!sock_) { |
| LOG(ERROR) << "Config80211::Init needs to be called before this"; |
| return; |
| } |
| |
| if (new_state == kWifiUp) { |
| // Install ourselves in the shill mainloop so we receive messages on the |
| // nl80211 socket. |
| if (dispatcher_) { |
| dispatcher_handler_.reset(dispatcher_->CreateInputHandler( |
| GetFd(), |
| dispatcher_callback_, |
| Bind(&Config80211::OnReadError, weak_ptr_factory_.GetWeakPtr()))); |
| } |
| |
| // If we're newly-up, subscribe to all the event types that have been |
| // requested. |
| SubscribedEvents::const_iterator i; |
| for (i = subscribed_events_.begin(); i != subscribed_events_.end(); ++i) { |
| ActuallySubscribeToEvents(*i); |
| } |
| } |
| wifi_state_ = new_state; |
| } |
| |
| bool Config80211::SubscribeToEvents(EventType type) { |
| bool it_worked = true; |
| if (!ContainsKey(subscribed_events_, type)) { |
| if (wifi_state_ == kWifiUp) { |
| it_worked = ActuallySubscribeToEvents(type); |
| } |
| // |subscribed_events_| is a list of events to which we want to subscribe |
| // when wifi comes up (including when it comes _back_ up after it goes |
| // down sometime in the future). |
| subscribed_events_.insert(type); |
| } |
| return it_worked; |
| } |
| |
| bool Config80211::ActuallySubscribeToEvents(EventType type) { |
| string group_name; |
| |
| if (!GetEventTypeString(type, &group_name)) { |
| return false; |
| } |
| if (!sock_->AddGroupMembership(group_name)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void Config80211::OnRawNlMessageReceived(InputData *data) { |
| if (!data) { |
| LOG(ERROR) << __func__ << "() called with null header."; |
| return; |
| } |
| unsigned char *buf = data->buf; |
| unsigned char *end = buf + data->len; |
| while (buf < end) { |
| nlmsghdr *msg = reinterpret_cast<nlmsghdr *>(buf); |
| // Discard the message if there're not enough bytes to a) tell the code how |
| // much space is in the message (i.e., to access nlmsg_len) or b) to hold |
| // the entire message. The odd calculation is there to keep the code from |
| // potentially calculating an illegal address (causes a segfault on some |
| // architectures). |
| size_t bytes_left = end - buf; |
| if (((bytes_left < (offsetof(nlmsghdr, nlmsg_len) + |
| sizeof(nlmsghdr::nlmsg_len))) || |
| (bytes_left < msg->nlmsg_len))) { |
| LOG(ERROR) << "Discarding incomplete message."; |
| return; |
| } |
| OnNlMessageReceived(msg); |
| buf += msg->nlmsg_len; |
| } |
| } |
| |
| void Config80211::OnNlMessageReceived(nlmsghdr *msg) { |
| if (!msg) { |
| LOG(ERROR) << __func__ << "() called with null header."; |
| return; |
| } |
| const uint32 sequence_number = msg->nlmsg_seq; |
| SLOG(WiFi, 3) << "\t Entering " << __func__ |
| << " (msg:" << sequence_number << ")"; |
| scoped_ptr<Nl80211Message> message(Nl80211MessageFactory::CreateMessage(msg)); |
| if (message == NULL) { |
| SLOG(WiFi, 3) << __func__ << "(msg:NULL)"; |
| return; // Skip current message, continue parsing buffer. |
| } |
| // Call (then erase) any message-specific callback. |
| // TODO(wdg): Support multi-part messages; don't delete callback until last |
| // part appears. |
| if (ContainsKey(message_callbacks_, sequence_number)) { |
| SLOG(WiFi, 3) << "found message-specific callback"; |
| if (message_callbacks_[sequence_number].is_null()) { |
| LOG(ERROR) << "Callback exists but is NULL for ID " << sequence_number; |
| } else { |
| message_callbacks_[sequence_number].Run(*message); |
| } |
| message_callbacks_.erase(sequence_number); |
| } else { |
| list<Callback>::const_iterator i = broadcast_callbacks_.begin(); |
| while (i != broadcast_callbacks_.end()) { |
| SLOG(WiFi, 3) << " " << __func__ << " - calling callback"; |
| i->Run(*message); |
| ++i; |
| } |
| } |
| } |
| |
| void Config80211::OnReadError(const Error &error) { |
| // TODO(wdg): When config80211 is used for scan, et al., this should either be |
| // LOG(FATAL) or the code should properly deal with errors, e.g., dropped |
| // messages due to the socket buffer being full. |
| LOG(ERROR) << "Config80211's netlink Socket read returns error: " |
| << error.message(); |
| } |
| |
| |
| } // namespace shill. |