Improved waypoint to tmap script
Now when creating the topological map from a waypoint file it will add a
Charging node (ChargingPoint) at position {0,0,0,0,0,0,0}
(this waypoint can't be on the waypoint file) and this node will
be conected to the first waypoint in the file only using the
docking action