| // 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 <netlink/netlink.h> |
| #include <sys/select.h> |
| #include <sys/time.h> |
| #include <map> |
| |
| #include <base/memory/weak_ptr.h> |
| #include <base/stl_util.h> |
| |
| #include "shill/attribute_list.h" |
| #include "shill/error.h" |
| #include "shill/event_dispatcher.h" |
| #include "shill/io_handler.h" |
| #include "shill/logging.h" |
| #include "shill/netlink_socket.h" |
| #include "shill/nl80211_message.h" |
| #include "shill/scope_logger.h" |
| #include "shill/shill_time.h" |
| |
| using base::Bind; |
| using base::LazyInstance; |
| using std::list; |
| using std::map; |
| using std::string; |
| |
| namespace shill { |
| |
| namespace { |
| LazyInstance<Config80211> g_config80211 = LAZY_INSTANCE_INITIALIZER; |
| } // namespace |
| |
| const char Config80211::kEventTypeConfig[] = "config"; |
| const char Config80211::kEventTypeScan[] = "scan"; |
| const char Config80211::kEventTypeRegulatory[] = "regulatory"; |
| const char Config80211::kEventTypeMlme[] = "mlme"; |
| const long Config80211::kMaximumNewFamilyWaitSeconds = 1; |
| const long Config80211::kMaximumNewFamilyWaitMicroSeconds = 0; |
| |
| Config80211::MessageType::MessageType() : |
| family_id(NetlinkMessage::kIllegalMessageType) {} |
| |
| Config80211::Config80211() |
| : dispatcher_(NULL), |
| weak_ptr_factory_(this), |
| dispatcher_callback_(Bind(&Config80211::OnRawNlMessageReceived, |
| weak_ptr_factory_.GetWeakPtr())), |
| sock_(NULL) {} |
| |
| Config80211 *Config80211::GetInstance() { |
| return g_config80211.Pointer(); |
| } |
| |
| void Config80211::Reset(bool full) { |
| ClearBroadcastHandlers(); |
| message_types_.clear(); |
| if (full) { |
| dispatcher_ = NULL; |
| delete sock_; |
| sock_ = NULL; |
| } |
| } |
| |
| void Config80211::OnNewFamilyMessage(const NetlinkMessage &raw_message) { |
| uint16_t family_id; |
| string family_name; |
| |
| if (raw_message.message_type() == ErrorAckMessage::kMessageType) { |
| const ErrorAckMessage *error_ack_message = |
| reinterpret_cast<const ErrorAckMessage *>(&raw_message); |
| if (error_ack_message->error()) { |
| LOG(ERROR) << __func__ << ": Message (seq: " |
| << raw_message.sequence_number() << ") failed: " |
| << error_ack_message->ToString(); |
| } else { |
| SLOG(WiFi, 6) << __func__ << ": Message (seq: " |
| << raw_message.sequence_number() << ") ACKed"; |
| } |
| return; |
| } |
| |
| if (raw_message.message_type() != ControlNetlinkMessage::kMessageType) { |
| LOG(ERROR) << "Received unexpected message type: " |
| << raw_message.message_type(); |
| return; |
| } |
| |
| const ControlNetlinkMessage *message = |
| reinterpret_cast<const ControlNetlinkMessage *>(&raw_message); |
| |
| if (!message->const_attributes()->GetU16AttributeValue(CTRL_ATTR_FAMILY_ID, |
| &family_id)) { |
| LOG(ERROR) << __func__ << ": Couldn't get family_id attribute"; |
| return; |
| } |
| |
| if (!message->const_attributes()->GetStringAttributeValue( |
| CTRL_ATTR_FAMILY_NAME, &family_name)) { |
| LOG(ERROR) << __func__ << ": Couldn't get family_name attribute"; |
| return; |
| } |
| |
| SLOG(WiFi, 3) << "Socket family '" << family_name << "' has id=" << family_id; |
| |
| // Extract the available multicast groups from the message. |
| AttributeListConstRefPtr multicast_groups; |
| if (message->const_attributes()->ConstGetNestedAttributeList( |
| CTRL_ATTR_MCAST_GROUPS, &multicast_groups)) { |
| AttributeListConstRefPtr current_group; |
| |
| for (int i = 1; |
| multicast_groups->ConstGetNestedAttributeList(i, ¤t_group); |
| ++i) { |
| string group_name; |
| uint32_t group_id; |
| if (!current_group->GetStringAttributeValue(CTRL_ATTR_MCAST_GRP_NAME, |
| &group_name)) { |
| LOG(WARNING) << "Expected CTRL_ATTR_MCAST_GRP_NAME, found none"; |
| continue; |
| } |
| if (!current_group->GetU32AttributeValue(CTRL_ATTR_MCAST_GRP_ID, |
| &group_id)) { |
| LOG(WARNING) << "Expected CTRL_ATTR_MCAST_GRP_ID, found none"; |
| continue; |
| } |
| SLOG(WiFi, 3) << " Adding group '" << group_name << "' = " << group_id; |
| message_types_[family_name].groups[group_name] = group_id; |
| } |
| } |
| |
| message_types_[family_name].family_id = family_id; |
| } |
| |
| bool Config80211::Init() { |
| // Install message factory for control class of messages, which has |
| // statically-known message type. |
| message_factory_.AddFactoryMethod( |
| ControlNetlinkMessage::kMessageType, |
| Bind(&ControlNetlinkMessage::CreateMessage)); |
| if (!sock_) { |
| sock_ = new NetlinkSocket; |
| if (!sock_) { |
| LOG(ERROR) << "No memory"; |
| return false; |
| } |
| |
| if (!sock_->Init()) { |
| return false; |
| } |
| } |
| return true; |
| } |
| |
| void Config80211::Start(EventDispatcher *dispatcher) { |
| dispatcher_ = dispatcher; |
| CHECK(dispatcher_); |
| // Install ourselves in the shill mainloop so we receive messages on the |
| // netlink socket. |
| dispatcher_handler_.reset(dispatcher_->CreateInputHandler( |
| file_descriptor(), |
| dispatcher_callback_, |
| Bind(&Config80211::OnReadError, weak_ptr_factory_.GetWeakPtr()))); |
| } |
| |
| int Config80211::file_descriptor() const { |
| return (sock_ ? sock_->file_descriptor() : -1); |
| } |
| |
| uint16_t Config80211::GetFamily(string name, |
| const NetlinkMessageFactory::FactoryMethod &message_factory) { |
| MessageType &message_type = message_types_[name]; |
| if (message_type.family_id != NetlinkMessage::kIllegalMessageType) { |
| return message_type.family_id; |
| } |
| if (!sock_) { |
| LOG(FATAL) << "Must call |Init| before this method."; |
| return false; |
| } |
| |
| GetFamilyMessage msg; |
| if (!msg.attributes()->CreateStringAttribute(CTRL_ATTR_FAMILY_NAME, |
| "CTRL_ATTR_FAMILY_NAME")) { |
| LOG(ERROR) << "Couldn't create string attribute"; |
| return false; |
| } |
| if (!msg.attributes()->SetStringAttributeValue(CTRL_ATTR_FAMILY_NAME, name)) { |
| LOG(ERROR) << "Couldn't set string attribute"; |
| return false; |
| } |
| SendMessage(&msg, Bind(&Config80211::OnNewFamilyMessage, |
| weak_ptr_factory_.GetWeakPtr())); |
| |
| // Wait for a response. The code absolutely needs family_ids for its |
| // message types so we do a synchronous wait. It's OK to do this because |
| // a) libnl does a synchronous wait (so there's prior art), b) waiting |
| // asynchronously would add significant and unnecessary complexity to the |
| // code that deals with pending messages that could, potentially, be waiting |
| // for a message type, and c) it really doesn't take very long for the |
| // GETFAMILY / NEWFAMILY transaction to transpire (this transaction was timed |
| // over 20 times and found a maximum duration of 11.1 microseconds and an |
| // average of 4.0 microseconds). |
| struct timeval start_time, now, end_time; |
| struct timeval maximum_wait_duration = {kMaximumNewFamilyWaitSeconds, |
| kMaximumNewFamilyWaitMicroSeconds}; |
| Time *time = Time::GetInstance(); |
| time->GetTimeMonotonic(&start_time); |
| now = start_time; |
| timeradd(&start_time, &maximum_wait_duration, &end_time); |
| |
| do { |
| // Wait with timeout for a message from the netlink socket. |
| fd_set read_fds; |
| FD_ZERO(&read_fds); |
| FD_SET(file_descriptor(), &read_fds); |
| struct timeval wait_duration; |
| timersub(&end_time, &now, &wait_duration); |
| int result = select(file_descriptor() + 1, &read_fds, NULL, NULL, |
| &wait_duration); |
| if (result < 0) { |
| PLOG(ERROR) << "Select failed"; |
| return NetlinkMessage::kIllegalMessageType; |
| } |
| if (result == 0) { |
| LOG(WARNING) << "Timed out waiting for family_id for family '" |
| << name << "'."; |
| return NetlinkMessage::kIllegalMessageType; |
| } |
| |
| // Read and process any messages. |
| ByteString received; |
| sock_->RecvMessage(&received); |
| InputData input_data(received.GetData(), received.GetLength()); |
| OnRawNlMessageReceived(&input_data); |
| if (message_type.family_id != NetlinkMessage::kIllegalMessageType) { |
| uint16_t family_id = message_type.family_id; |
| if (family_id != NetlinkMessage::kIllegalMessageType) { |
| message_factory_.AddFactoryMethod(family_id, message_factory); |
| } |
| time->GetTimeMonotonic(&now); |
| timersub(&now, &start_time, &wait_duration); |
| SLOG(WiFi, 5) << "Found id " << message_type.family_id |
| << " for name '" << name << "' in " |
| << wait_duration.tv_sec << " sec, " |
| << wait_duration.tv_usec << " usec."; |
| return message_type.family_id; |
| } |
| time->GetTimeMonotonic(&now); |
| } while (timercmp(&now, &end_time, <)); |
| |
| LOG(ERROR) << "Timed out waiting for family_id for family '" << name << "'."; |
| return NetlinkMessage::kIllegalMessageType; |
| } |
| |
| uint16_t Config80211::GetMessageType(string name) const { |
| map<const string, MessageType>::const_iterator family = |
| message_types_.find(name); |
| if (family == message_types_.end()) { |
| LOG(WARNING) << "Family '" << name << "' is not in list."; |
| return NetlinkMessage::kIllegalMessageType; |
| } |
| return family->second.family_id; |
| } |
| |
| bool Config80211::AddBroadcastHandler(const NetlinkMessageHandler &handler) { |
| list<NetlinkMessageHandler>::iterator i; |
| if (FindBroadcastHandler(handler)) { |
| LOG(WARNING) << "Trying to re-add a handler"; |
| return false; // Should only be one copy in the list. |
| } |
| if (handler.is_null()) { |
| LOG(WARNING) << "Trying to add a NULL handler"; |
| return false; |
| } |
| // And add the handler to the list. |
| SLOG(WiFi, 3) << "Config80211::" << __func__ << " - adding handler"; |
| broadcast_handlers_.push_back(handler); |
| return true; |
| } |
| |
| bool Config80211::RemoveBroadcastHandler( |
| const NetlinkMessageHandler &handler) { |
| list<NetlinkMessageHandler>::iterator i; |
| for (i = broadcast_handlers_.begin(); i != broadcast_handlers_.end(); ++i) { |
| if ((*i).Equals(handler)) { |
| broadcast_handlers_.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) << "NetlinkMessageHandler not found."; |
| return false; |
| } |
| |
| bool Config80211::FindBroadcastHandler(const NetlinkMessageHandler &handler) |
| const { |
| list<NetlinkMessageHandler>::const_iterator i; |
| for (i = broadcast_handlers_.begin(); i != broadcast_handlers_.end(); ++i) { |
| if ((*i).Equals(handler)) { |
| return true; |
| } |
| } |
| return false; |
| } |
| |
| void Config80211::ClearBroadcastHandlers() { |
| broadcast_handlers_.clear(); |
| } |
| |
| bool Config80211::SendMessage(NetlinkMessage *message, |
| const NetlinkMessageHandler &handler) { |
| if (!message) { |
| LOG(ERROR) << "Message is NULL."; |
| return false; |
| } |
| |
| ByteString message_string = message->Encode(this->GetSequenceNumber()); |
| |
| if (handler.is_null()) { |
| SLOG(WiFi, 3) << "Handler for message was null."; |
| } else if (ContainsKey(message_handlers_, message->sequence_number())) { |
| LOG(ERROR) << "A handler already existed for sequence: " |
| << message->sequence_number(); |
| return false; |
| } else { |
| message_handlers_[message->sequence_number()] = handler; |
| } |
| |
| SLOG(WiFi, 6) << "NL Message " << message->sequence_number() |
| << " Sending (" << message_string.GetLength() |
| << " bytes) ===>"; |
| message->Print(6); |
| NetlinkMessage::PrintBytes(6, message_string.GetConstData(), |
| message_string.GetLength()); |
| |
| if (!sock_->SendMessage(message_string)) { |
| LOG(ERROR) << "Failed to send Netlink message."; |
| return false; |
| } |
| return true; |
| } |
| |
| bool Config80211::RemoveMessageHandler(const NetlinkMessage &message) { |
| if (!ContainsKey(message_handlers_, message.sequence_number())) { |
| return false; |
| } |
| message_handlers_.erase(message.sequence_number()); |
| return true; |
| } |
| |
| uint32_t Config80211::GetSequenceNumber() { |
| return sock_ ? |
| sock_->GetSequenceNumber() : NetlinkMessage::kBroadcastSequenceNumber; |
| } |
| |
| bool Config80211::SubscribeToEvents(const string &family_id, |
| const string &group_name) { |
| if (!ContainsKey(message_types_, family_id)) { |
| LOG(ERROR) << "Family '" << family_id << "' doesn't exist"; |
| return false; |
| } |
| |
| if (!ContainsKey(message_types_[family_id].groups, group_name)) { |
| LOG(ERROR) << "Group '" << group_name << "' doesn't exist in family '" |
| << family_id << "'"; |
| return false; |
| } |
| |
| uint32_t group_id = message_types_[family_id].groups[group_name]; |
| if (!sock_) { |
| LOG(FATAL) << "Need to call |Init| first."; |
| } |
| return sock_->SubscribeToEvents(group_id); |
| } |
| |
| 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(msg->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; |
| scoped_ptr<NetlinkMessage> message(message_factory_.CreateMessage(msg)); |
| if (message == NULL) { |
| SLOG(WiFi, 3) << "NL Message " << sequence_number << " <==="; |
| SLOG(WiFi, 3) << __func__ << "(msg:NULL)"; |
| return; // Skip current message, continue parsing buffer. |
| } |
| SLOG(WiFi, 3) << "NL Message " << sequence_number |
| << " Received (" << msg->nlmsg_len << " bytes) <==="; |
| message->Print(6); |
| NetlinkMessage::PrintBytes(8, reinterpret_cast<const unsigned char *>(msg), |
| msg->nlmsg_len); |
| |
| // Call (then erase) any message-specific handler. |
| if (ContainsKey(message_handlers_, sequence_number)) { |
| SLOG(WiFi, 3) << "found message-specific handler"; |
| if (message_handlers_[sequence_number].is_null()) { |
| LOG(ERROR) << "NetlinkMessageHandler exists but is NULL for ID " |
| << sequence_number; |
| } else { |
| message_handlers_[sequence_number].Run(*message); |
| } |
| |
| if (message->message_type() == ErrorAckMessage::kMessageType) { |
| const ErrorAckMessage *error_ack_message = |
| reinterpret_cast<const ErrorAckMessage *>(message.get()); |
| if (error_ack_message->error()) { |
| SLOG(WiFi, 3) << "Removing callback"; |
| message_handlers_.erase(sequence_number); |
| } else { |
| SLOG(WiFi, 3) << "ACK message -- not removing callback"; |
| } |
| } else if ((message->flags() & NLM_F_MULTI) && |
| (message->message_type() != NLMSG_DONE)) { |
| SLOG(WiFi, 3) << "Multi-part message -- not removing callback"; |
| } else { |
| SLOG(WiFi, 3) << "Removing callback"; |
| message_handlers_.erase(sequence_number); |
| } |
| } else { |
| list<NetlinkMessageHandler>::const_iterator i = |
| broadcast_handlers_.begin(); |
| while (i != broadcast_handlers_.end()) { |
| SLOG(WiFi, 3) << __func__ << " - calling broadcast handler"; |
| 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. |