A RSSI Localization Algorithm and Implementation for Indoor Wireless Sensor Networks