<sat>9</sat>\r
</wpt>\r
*/\r
- DocumentBuilderFactory factory;\r
- DocumentBuilder builder;\r
- Node gpx;\r
-\r
try {\r
if (params.getProperty(AppParameters.IMG_OUTPUT).equals(Boolean.toString(true))) {\r
outDir = new File(outDir, imgDir.getName());\r
}\r
\r
for (File gpxFile : this.gpxFiles) {\r
- String fileName = gpxFile.getName();\r
- String iStr = fileName.substring(0, fileName.length() - 4);\r
-\r
- File outputFile = new File(outDir, iStr +"_.gpx");\r
- System.out.println(gpxFile.getAbsolutePath() + " => "+ outputFile.getAbsolutePath());\r
- System.out.println(" 時差: "+ (delta / 1000) +"(sec)");\r
- System.out.println(" Target GPX: ["+ gpxFile.getAbsolutePath() +"]");\r
- System.out.println(" EXIF: "+ (exif ? ("convert to '" + outDir.getAbsolutePath() +"'") : "off"));\r
- System.out.println();\r
-\r
- factory = DocumentBuilderFactory.newInstance();\r
- builder = factory.newDocumentBuilder();\r
- factory.setIgnoringElementContentWhitespace(true);\r
- factory.setIgnoringComments(true);\r
- factory.setValidating(true);\r
-\r
- // GPX file --> Node root\r
- DOMImplementation domImpl = builder.getDOMImplementation();\r
- document = domImpl.createDocument("", "gpx", null);\r
-\r
- /*\r
- * <gpx>\r
- * <trk>\r
- * <name><![CDATA[Tracked with OSMTracker for Android?]]></name>\r
- * <cmt><![CDATA[警告: HDOP values aren't the HDOP as returned by the GPS device. They're approximated from the location accuracy in meters.]]></cmt>\r
- * <trkseg>\r
- * <trkpt lat="35.32123832" lon="139.56965631">\r
- * <ele>47.20000076293945</ele>\r
- * <time>2012-06-15T03:00:29Z</time>\r
- * <hdop>0.5</hdop>\r
- * </trkpt>\r
- * </trkseg>\r
- * </trk>\r
- * <wpt lat="35.2564461" lon="139.15437809"></wpt>\r
- * </gpx>\r
- */\r
- TreeMap<Long,Element> map = new TreeMap<>();\r
- TreeMap<Long,Element> mapTRKSEG = new TreeMap<>();\r
- Element trk = null;\r
- gpx = builder.parse(gpxFile).getFirstChild();\r
- Document doc = gpx.getOwnerDocument();\r
- NodeList nodes = gpx.getChildNodes();\r
- for (int i=0; i < nodes.getLength(); i++) {\r
- Node node2 = nodes.item(i);\r
- if (node2.getNodeName().equals("trk")) {\r
- trk = (Element) node2;\r
- \r
- NodeList nodes1 = trk.getChildNodes();\r
- int trksegCounter = 0;\r
- for (int i1=0; i1 < nodes1.getLength(); i1++) {\r
- Node nodeTRKSEG = nodes1.item(i1);\r
- if (nodeTRKSEG.getNodeName().equals("trkseg")) {\r
- trksegCounter++;\r
- Element newTRKSEG = doc.createElement("trkseg");\r
- Element trkseg = (Element) nodeTRKSEG;\r
- NodeList nodes2 = trkseg.getChildNodes();\r
- for (int i2=0; i2 < nodes2.getLength(); i2++) {\r
- Node nodeTRKPT = nodes2.item(i2);\r
- if (nodeTRKPT.getNodeName().equals("trkpt")) {\r
- if (param_GpxNoFirstNode && (i2 == 0)) {\r
- continue;\r
- }\r
- newTRKSEG.appendChild(getCopy(doc, nodeTRKPT));\r
- }\r
- }\r
- mapTRKSEG.put(new Long(trksegCounter), getCopy(doc, newTRKSEG));\r
+ procGPXfile(gpxFile);\r
+ }\r
+ }\r
+ catch(ParserConfigurationException | DOMException | SAXException | IOException | ParseException | ImageReadException | ImageWriteException | IllegalArgumentException | TransformerException e) {\r
+ }\r
+ }\r
+ \r
+ /**\r
+ * 個別のGPXファイルを処理する\r
+ * \r
+ * @throws ParserConfigurationException \r
+ * @throws IOException \r
+ * @throws SAXException \r
+ * @throws ParseException \r
+ * @throws ImageWriteException \r
+ * @throws ImageReadException \r
+ * @throws TransformerException \r
+ */\r
+ void procGPXfile(File gpxFile) throws ParserConfigurationException, SAXException, IOException, ParseException, ImageReadException, ImageWriteException, TransformerException {\r
+ DocumentBuilderFactory factory;\r
+ DocumentBuilder builder;\r
+ Node gpx;\r
\r
- // <trk>から<trkseg>を削除する。\r
- trk.removeChild(nodeTRKSEG);\r
+ String fileName = gpxFile.getName();\r
+ String iStr = fileName.substring(0, fileName.length() - 4);\r
+\r
+ File outputFile = new File(outDir, iStr +"_.gpx");\r
+ System.out.println(gpxFile.getAbsolutePath() + " => "+ outputFile.getAbsolutePath());\r
+ System.out.println(" 時差: "+ (delta / 1000) +"(sec)");\r
+ System.out.println(" Target GPX: ["+ gpxFile.getAbsolutePath() +"]");\r
+ System.out.println(" EXIF: "+ (exif ? ("convert to '" + outDir.getAbsolutePath() +"'") : "off"));\r
+ System.out.println();\r
+\r
+ factory = DocumentBuilderFactory.newInstance();\r
+ builder = factory.newDocumentBuilder();\r
+ factory.setIgnoringElementContentWhitespace(true);\r
+ factory.setIgnoringComments(true);\r
+ factory.setValidating(true);\r
+\r
+ // GPX file --> Node root\r
+ DOMImplementation domImpl = builder.getDOMImplementation();\r
+ document = domImpl.createDocument("", "gpx", null);\r
+\r
+ /*\r
+ * <gpx>\r
+ * <trk>\r
+ * <name><![CDATA[Tracked with OSMTracker for Android?]]></name>\r
+ * <cmt><![CDATA[警告: HDOP values aren't the HDOP as returned by the GPS device. They're approximated from the location accuracy in meters.]]></cmt>\r
+ * <trkseg>\r
+ * <trkpt lat="35.32123832" lon="139.56965631">\r
+ * <ele>47.20000076293945</ele>\r
+ * <time>2012-06-15T03:00:29Z</time>\r
+ * <hdop>0.5</hdop>\r
+ * </trkpt>\r
+ * </trkseg>\r
+ * </trk>\r
+ * <wpt lat="35.2564461" lon="139.15437809"></wpt>\r
+ * </gpx>\r
+ */\r
+ TreeMap<Long,Element> map = new TreeMap<>();\r
+ TreeMap<Long,Element> mapTRKSEG = new TreeMap<>();\r
+ Element trk = null;\r
+ Element maeTRKPT = null;\r
+ gpx = builder.parse(gpxFile).getFirstChild();\r
+ Document doc = gpx.getOwnerDocument();\r
+ NodeList nodes = gpx.getChildNodes();\r
+ for (int i=0; i < nodes.getLength(); i++) {\r
+ Node node2 = nodes.item(i);\r
+ if (node2.getNodeName().equals("trk")) {\r
+ trk = (Element) node2;\r
+ \r
+ NodeList nodes1 = trk.getChildNodes();\r
+ int trksegCounter = 0;\r
+ for (int i1=0; i1 < nodes1.getLength(); i1++) {\r
+ Node nodeTRKSEG = nodes1.item(i1);\r
+ if (nodeTRKSEG.getNodeName().equals("trkseg")) {\r
+ trksegCounter++;\r
+ Element newTRKSEG = doc.createElement("trkseg");\r
+ Element trkseg = (Element) nodeTRKSEG;\r
+ NodeList nodes2 = trkseg.getChildNodes();\r
+ for (int i2=0; i2 < nodes2.getLength(); i2++) {\r
+ Node nodeTRKPT = nodes2.item(i2);\r
+ if (nodeTRKPT.getNodeName().equals("trkpt")) {\r
+ if (param_GpxNoFirstNode && (i2 == 0)) {\r
+ continue;\r
+ }\r
+ if (param_GpxOutputSpeed || param_GpxOverwriteMagvar) {\r
+ Complementation cmp = new Complementation((Element)nodeTRKPT, maeTRKPT);\r
+ if (param_GpxOutputSpeed) {\r
+ if (cmp.speed != null) {\r
+ nodeTRKPT.removeChild(cmp.speed);\r
+ }\r
+ if (maeTRKPT != null) {\r
+ cmp.complementationSpeed((Element)nodeTRKPT);\r
+ }\r
+ }\r
+ if (param_GpxOverwriteMagvar) {\r
+ if (cmp.magvar != null) {\r
+ nodeTRKPT.removeChild(cmp.magvar);\r
+ }\r
+ if (maeTRKPT != null) {\r
+ cmp.complementationMagvar((Element)nodeTRKPT);\r
+ }\r
+ }\r
+ }\r
+ maeTRKPT = getCopy(doc, nodeTRKPT);\r
+ newTRKSEG.appendChild(getCopy(doc, nodeTRKPT));\r
}\r
}\r
- \r
- // <trkseg>毎に実行する\r
- Iterator<Long> keyIte = mapTRKSEG.keySet().iterator();\r
- while (keyIte.hasNext()) { //ループ。反復子iteratorによる キー 取得\r
-\r
- // <trk>に、新たな<trkseg>を追加する。\r
- Element newTRKSEG = mapTRKSEG.get(keyIte.next());\r
- trk.appendChild(newTRKSEG);\r
- \r
- // mapに、<trkpy>を割り付ける\r
- trkptMap(newTRKSEG, map);\r
- }\r
+ mapTRKSEG.put(new Long(trksegCounter), getCopy(doc, newTRKSEG));\r
+\r
+ // <trk>から<trkseg>を削除する。\r
+ trk.removeChild(nodeTRKSEG);\r
}\r
}\r
\r
- /*\r
- * GPXへ割りつける開始時刻と終了時刻を求める\r
- */\r
- long gpxStartTime = (new Date()).getTime(); // 対象とする開始時刻(現在時刻)\r
- long gpxEndTime = 0L; // 対象とする終了時刻\r
- Set<Long> keySet = map.keySet(); //すべてのキー値を取得\r
- for (Long timeLong : keySet) {\r
- long gpxTime = timeLong;\r
- if (gpxStartTime > gpxTime) {\r
- gpxStartTime = gpxTime;\r
- }\r
- if (gpxEndTime < gpxTime) {\r
- gpxEndTime = gpxTime;\r
- }\r
- }\r
- \r
- System.out.println("GPX start time: "+ dfjp.format(new Date(gpxStartTime)) + "\t[GMT " + dfuk.format(new Date(gpxStartTime))+"]");\r
- System.out.println(" GPX end time: "+ dfjp.format(new Date(gpxEndTime)) + "\t[GMT " + dfuk.format(new Date(gpxEndTime))+"]");\r
- System.out.println("------------|--------------------|--------------------|------------|------------|--------|------|");\r
- System.out.println(" name | UpdateTime | GPStime | Latitude | Longitude | ele |magvar|");\r
- System.out.println("------------|--------------------|--------------------|------------|------------|--------|------|");\r
- proc(imgDir, delta, gpxStartTime, gpxEndTime, map, exif, gpx);\r
- System.out.println("------------|--------------------|--------------------|------------|------------|--------|------|");\r
-\r
- // 出力\r
- DOMSource source = new DOMSource(gpx);\r
- FileOutputStream os = new FileOutputStream(outputFile);\r
- StreamResult result = new StreamResult(os);\r
- TransformerFactory transFactory = TransformerFactory.newInstance();\r
- Transformer transformer = transFactory.newTransformer();\r
- transformer.setOutputProperty(OutputKeys.INDENT, "yes");\r
- transformer.setOutputProperty(OutputKeys.METHOD, "xml");\r
- transformer.transform(source, result); \r
- if (exif) {\r
- outputFile = new File(outDir, iStr +"_.gpx");\r
- os = new FileOutputStream(outputFile);\r
- result = new StreamResult(os);\r
- transformer.transform(source, result);\r
+ // <trkseg>毎に実行する\r
+ Iterator<Long> keyIte = mapTRKSEG.keySet().iterator();\r
+ while (keyIte.hasNext()) { //ループ。反復子iteratorによる キー 取得\r
+\r
+ // <trk>に、新たな<trkseg>を追加する。\r
+ Element newTRKSEG = mapTRKSEG.get(keyIte.next());\r
+ trk.appendChild(newTRKSEG);\r
+ \r
+ // mapに、<trkpt>を割り付ける\r
+ trkptMap(newTRKSEG, map);\r
}\r
}\r
}\r
- catch(ParserConfigurationException | DOMException | SAXException | IOException | ParseException | ImageReadException | ImageWriteException | IllegalArgumentException | TransformerException e) {\r
- }\r
+ \r
+ /*\r
+ * GPXへ割りつける開始時刻と終了時刻を求める\r
+ */\r
+ long gpxStartTime = (new Date()).getTime(); // 対象とする開始時刻(現在時刻)\r
+ long gpxEndTime = 0L; // 対象とする終了時刻\r
+ Set<Long> keySet = map.keySet(); //すべてのキー値を取得\r
+ for (Long timeLong : keySet) {\r
+ long gpxTime = timeLong;\r
+ if (gpxStartTime > gpxTime) {\r
+ gpxStartTime = gpxTime;\r
+ }\r
+ if (gpxEndTime < gpxTime) {\r
+ gpxEndTime = gpxTime;\r
+ }\r
+ }\r
+ \r
+ System.out.println("GPX start time: "+ dfjp.format(new Date(gpxStartTime)) + "\t[GMT " + dfuk.format(new Date(gpxStartTime))+"]");\r
+ System.out.println(" GPX end time: "+ dfjp.format(new Date(gpxEndTime)) + "\t[GMT " + dfuk.format(new Date(gpxEndTime))+"]");\r
+ System.out.println("------------|--------------------|--------------------|------------|------------|--------|------|------|");\r
+ System.out.println(" name | UpdateTime | GPStime | Latitude | Longitude | ele |magvar| speed|");\r
+ System.out.println("------------|--------------------|--------------------|------------|------------|--------|------|------|");\r
+ proc(imgDir, delta, gpxStartTime, gpxEndTime, map, exif, gpx);\r
+ System.out.println("------------|--------------------|--------------------|------------|------------|--------|------|------|");\r
+\r
+ // 出力\r
+ DOMSource source = new DOMSource(gpx);\r
+ FileOutputStream os = new FileOutputStream(outputFile);\r
+ StreamResult result = new StreamResult(os);\r
+ TransformerFactory transFactory = TransformerFactory.newInstance();\r
+ Transformer transformer = transFactory.newTransformer();\r
+ transformer.setOutputProperty(OutputKeys.INDENT, "yes");\r
+ transformer.setOutputProperty(OutputKeys.METHOD, "xml");\r
+ transformer.transform(source, result); \r
+\r
+ outputFile = new File(outDir, iStr +"_.gpx");\r
+ os = new FileOutputStream(outputFile);\r
+ result = new StreamResult(os);\r
+ transformer.transform(source, result);\r
+\r
}\r
+ \r
\r
/**\r
* 再帰メソッド\r
itime = new Date(lastModifyTime);\r
}\r
\r
+ // uktime <-- 画像撮影時刻に対応するGPX時刻\r
Date uktime = new Date(itime.getTime() + delta);\r
System.out.print(String.format("%20s ", dfjp.format(itime)));\r
System.out.print(String.format("%20s|", dfjp.format(uktime)));\r
continue;\r
}\r
\r
+ // 時刻uktimeにおける<magver>をtrkptに追加する\r
Element trkpt = trkpt(map, uktime);\r
if (trkpt == null) {\r
System.out.println(String.format("%20s ", "Out of GPX logging time."));\r
\r
String eleStr = "-";\r
String magvarStr = "-";\r
+ String speedStr = "-";\r
NodeList nodes = wpt.getChildNodes(); // 子ノードを取得\r
for (int i4 = 0; i4 < nodes.getLength(); i4++) {\r
Node node = nodes.item(i4);\r
case "magvar":\r
magvarStr = node.getFirstChild().getNodeValue();\r
break;\r
+ case "speed":\r
+ speedStr = node.getFirstChild().getNodeValue();\r
+ break;\r
}\r
}\r
}\r
\r
System.out.print(String.format("%12s %12s|", latStr, lonStr));\r
- System.out.println(String.format("%8s|%6s|", eleStr, magvarStr));\r
+ System.out.println(String.format("%8s|%6s|%s|", eleStr, magvarStr, speedStr));\r
ret = true;\r
\r
if (exifWrite) {\r
/**\r
* XMLエレメント<trkpt>をTIMEでキー付したHashMapを生成する<br>\r
* \r
- * <trkseg><trkpt><time>2014-01-01T00:59:09Z</time></trkpt></trkseg>\r
+ * <trkseg>\r
+ * <trkpt lat="34.976635" lon="138.466228">\r
+ * <ele>267.291</ele>\r
+ * <magvar>359</magvar>\r
+ * <speed></speed>\r
+ * <time>2016-07-02T08:25:18Z</time>\r
+ * </trkpt>\r
+ * </trkseg>\r
* \r
* @param trk\r
* @param map\r
}\r
}\r
\r
+ \r
/**\r
* <trkpt lat="35.32123832" lon="139.56965631">\r
* <ele>47.20000076293945</ele>\r
* @throws ParseException\r
*/\r
public Element trkpt(TreeMap<Long,Element> map, Date jptime) throws ParseException {\r
- Double R = 20000000 / Math.PI;\r
long sa = 2L * 3600000L;\r
long jpt = jptime.getTime();\r
Element ret = null;\r
while (keyIte.hasNext()) { //ループ。反復子iteratorによる キー 取得\r
Long time = keyIte.next();\r
long t = time;\r
+\r
if (Math.abs(jpt - t) < sa) {\r
sa = Math.abs(jpt - t);\r
ret = map.get(time);\r
\r
// <MAGVAR>がなければ、\r
// 直前の位置と、現在地から進行方向を求める\r
- NodeList nodes3 = ret.getChildNodes();\r
Element magvar = null;\r
- for (int i3=0; i3 < nodes3.getLength(); i3++) {\r
- Node node4 = nodes3.item(i3);\r
- if (node4.getNodeName().toLowerCase().equals("magvar")) {\r
- magvar = (Element) node4;\r
- break;\r
- }\r
- }\r
- if ((magvar == null) || param_GpxOverwriteMagvar) {\r
- if (mae != null) {\r
- Double maeLAT = null;\r
- Double maeLON = null;\r
- Double imaLAT = null;\r
- Double imaLON =null;\r
-\r
- // 経度(longitude)と経度から進行方向を求める\r
- NamedNodeMap nodeMap = mae.getAttributes();\r
- if (null != nodeMap) {\r
- for (int j=0; j < nodeMap.getLength(); j++ ) {\r
- switch (nodeMap.item(j).getNodeName()) {\r
- case "lat":\r
- String latStr = nodeMap.item(j).getNodeValue();\r
- maeLAT = new Double(latStr);\r
- break;\r
- case "lon":\r
- String lonStr = nodeMap.item(j).getNodeValue();\r
- maeLON = new Double(lonStr);\r
- break;\r
- }\r
- }\r
- nodeMap = ret.getAttributes();\r
- for (int j=0; j < nodeMap.getLength(); j++ ) {\r
- switch (nodeMap.item(j).getNodeName()) {\r
- case "lat":\r
- String latStr = nodeMap.item(j).getNodeValue();\r
- imaLAT = new Double(latStr);\r
- break;\r
- case "lon":\r
- String lonStr = nodeMap.item(j).getNodeValue();\r
- imaLON = new Double(lonStr);\r
- break;\r
- }\r
- }\r
- Double r = Math.cos(Math.toRadians((imaLAT + maeLAT) / 2)) * R;\r
- Double x = Math.toRadians(imaLON - maeLON) * r;\r
- Double y = Math.toRadians(imaLAT - maeLAT) * R;\r
- double rad = Math.toDegrees(Math.atan2(y, x));\r
- \r
- if (y >= 0) {\r
- if (x >= 0) {\r
- rad = 0 - (rad - 90);\r
- }\r
- else {\r
- rad = 360 - (rad - 90);\r
- }\r
- }\r
- else {\r
- if (x >= 0) {\r
- rad = 90 - rad;\r
- }\r
- else {\r
- rad = 90 - rad;\r
- }\r
- }\r
\r
- magvar = ret.getOwnerDocument().createElement("magvar");\r
- String str = Double.toString(rad);\r
- int iDot = str.indexOf('.');\r
- if (iDot > 0) {\r
- str = str.substring(0, iDot);\r
- }\r
- magvar.setTextContent(str);\r
- ret.appendChild(magvar);\r
- \r
- Element speed = ret.getOwnerDocument().createElement("speed");\r
- str = Double.toString(Math.sqrt(Math.pow(x, 2) + Math.pow(y, 2)));\r
- iDot = str.indexOf('.');\r
- if (iDot > 0) {\r
- str = str.substring(0, iDot);\r
- }\r
- speed.setTextContent(str);\r
- ret.appendChild(speed);\r
- }\r
+ if (mae != null) {\r
+ Complementation obj = new Complementation(ret, mae);\r
+\r
+ // 経度(longitude)と経度から進行方向を求める\r
+ if ((magvar == null) || param_GpxOverwriteMagvar) {\r
+ obj.complementationMagvar(ret);\r
}\r
+\r
+ // 緯度・経度と時間差から速度(m/sec)を求める\r
+ obj.complementationSpeed(ret);\r
+ \r
+ magvar = obj.magvar;\r
}\r
}\r
mae = map.get(time);\r
return null;\r
}\r
\r
+\r
/**\r
* 対象は '*.JPG' のみ対象とする\r
* @return \r
}\r
}\r
break;\r
+ case "speed":\r
+ for (int i2=0; i2 < nodes2.getLength(); i2++) {\r
+ Node node2 = nodes2.item(i2);\r
+ if (node2 != null) {\r
+ if (node2.getNodeType() == Node.TEXT_NODE) {\r
+ String speedStr = node2.getNodeValue();\r
+ Element speedE = document.createElement("speed");\r
+ speedE.setTextContent(speedStr);\r
+ wpt.appendChild(speedE);\r
+ }\r
+ }\r
+ }\r
+ break;\r
}\r
}\r
\r