lqml/examples/meshtastic/lisp/location.lisp
2024-03-17 13:45:23 +01:00

238 lines
8.5 KiB
Common Lisp

(in-package :loc)
(defvar *positions* nil)
(defvar *manual-position* nil)
(defvar *gps-position* nil)
(defparameter *default-position* (list :lat 41.89193 :lon 12.51133 :time 0) ; Rome
"Position of map center for manual position selection (no GPS).")
(defun ini ()
#+android (qt:ini-positioning qt:*cpp*)
#+(or ios sfos) (q> |active| ui:*position-source* t)
(x:when-it (app:setting :selected-position)
(setf *manual-position* x:it))
#+(or android ios sfos) (update-my-position))
(defun latest-gps-position ()
(let* ((pos #+android (qrun* (qt:last-position qt:*cpp*)) ; 'qrun*': return value
#-android (qjs |lastPosition| ui:*position-source*))
(time (third pos)))
(when (stringp time)
(setf (third pos) (parse-integer time))) ; see QML
pos))
(defun share-my-location () ; see QML
"Share GPS position (ad hoc only)."
(app:confirm-dialog (tr "Share my location now?") 'do-share-my-location)
(values))
(defun do-share-my-location (share)
(when share
(send-to-radio)))
#+(or android ios sfos)
(defun update-my-position (&optional (sec 60)) ; try for 1 min
"Store current position internally, without sharing it, so we have a base for
eventual manual position setting."
(destructuring-bind (lat lon time)
(latest-gps-position)
(if (zerop lat)
(unless (zerop sec)
(qsingle-shot 1000 (lambda () (update-my-position (1- sec)))))
(let ((pos (list :lat lat :lon lon :time time)))
(setf *gps-position* pos)
(qlog "position-updated: ~A" pos)))))
(defun send-to-radio ()
(when (app:setting :share-location)
(if lora:*config-complete*
(lora:send-position (or *manual-position* *gps-position*))
(qsingle-shot (* 15 1000) 'send-to-radio))))
(defun position* (node)
(when node
(x:when-it (or (getf *positions* node)
(and (= node (lora:my-num))
(or *manual-position*
*gps-position*)))
(list (getf x:it :lat)
(getf x:it :lon)))))
(defun set-position (node pos)
(when (and node pos)
(let ((lat (getf pos :lat)))
(when (and node lat (not (zerop lat)))
(setf (getf *positions* node) pos)))))
(defun position-selected (lat lon) ; see QML
(let ((pos (list :lat lat :lon lon :time 0)))
(setf *manual-position* pos)
(app:change-setting :selected-position *manual-position*)
(qlog "position-updated: ~A" pos))
(q> |visible| ui:*remove-marker* t)
(values))
(defun remove-marker () ; see QML
(setf *manual-position* nil)
(remf *positions* (lora:my-num))
(app:change-setting :selected-position nil)
;; update map
(qlater-sequence
(show-map-clicked) ; remove
(show-map-clicked)) ; load
(values))
;;; distance
(defconstant +earth-mean-radius+ 6371.0072d0)
(defun to-rad (deg)
(/ (* deg pi) 180))
(defun distance (from to)
;; Haversine formula
(destructuring-bind ((lat-1 lon-1) (lat-2 lon-2))
(list from to)
(if (and (numberp lat-1)
(numberp lat-2))
(let* ((dlat (to-rad (- lat-2 lat-1)))
(dlon (to-rad (- lon-2 lon-1)))
(h-dlat (sin (/ dlat 2)))
(h-dlon (sin (/ dlon 2))))
(setf h-dlat (expt h-dlat 2)
h-dlon (expt h-dlon 2))
(let* ((y (+ h-dlat (* (cos (to-rad lat-1))
(cos (to-rad lat-2))
h-dlon)))
(x (* 2 (asin (sqrt y)))))
(floor (+ 0.5 (* x +earth-mean-radius+ 1000)))))
0)))
(defun tile-path () ; see QML
(namestring (app:in-data-path "" "tiles/")))
(defun tile-provider-path () ; see QML
(if (probe-file "qml/tile-provider/")
(x:cc "file://" (namestring (merge-pathnames "qml/tile-provider/"))) ; development
"qrc:///qml/tile-provider/")) ; final app
(defun center-position ()
(flet ((mean (x)
(/ (reduce '+ (loop :for pr = *positions* :then (cddr pr)
:while pr :collect (getf (second pr) x)))
(/ (length *positions*) 2))))
(when *positions*
(list :lat (mean :lat)
:lon (mean :lon)))))
(defun set-map-center (pos)
(qjs |setCenter| ui:*map*
(list (getf pos :lat)
(getf pos :lon))))
(defun activate-map ()
(unless (q< |active| ui:*map-loader*)
(q> |active| ui:*map-loader* t)
(set-map-center (or *manual-position*
*gps-position*
(center-position)
*default-position*))))
(defun show-map-clicked () ; see QML
(when (lora:radio-ready-p)
(let ((show (not (q< |visible| ui:*map-view*))))
(when show
(activate-map)
(x:when-it (lora:my-num)
(qjs |updatePositions| ui:*map*
x:it
(lora:my-name)
(find-quick-item ui:*group*))
(q> |visible| ui:*add-manual-marker* t)))
(q> |visible| ui:*map-view* show)
;; move map (not page) when swiping to left
(q> |interactive| ui:*main-view* (not show))
(if show
(q> |visible| ui:*remove-marker*
(app:setting :selected-position))
(q> |active| ui:*map-loader* nil)))
(values)))
(defun add-manual-marker () ; see QML
(setf *manual-position* (or (center-position)
*default-position*))
;; update map
(qlater-sequence
(show-map-clicked) ; remove
(show-map-clicked) ; load
(q! |onClicked| ui:*add-manual-marker*))
(values))
(defun position-count () ; see QML
(set-position (lora:my-num)
(or *manual-position* *gps-position*))
(/ (length *positions*) 2)) ; property list
;;; save/restore tiles
(defun copy-stream (from to &optional (size most-positive-fixnum))
(let* ((buf-size (min 8192 size))
(buf (make-array buf-size :element-type (stream-element-type from))))
(loop :for pos = (read-sequence buf from :end (min buf-size size))
:do (write-sequence buf to :end pos)
(decf size pos)
:until (or (zerop pos)
(zerop size))))
(values))
(defun make-map-bin ()
"Writes all tiles in a single file, because images are already compressed.
This is meant to avoid useless (and possibly slow) zipping."
(with-open-file (out (app:in-data-path app:*backup-map-file* "backup/")
:direction :output :if-exists :supersede
:element-type '(unsigned-byte 8))
(let ((directories (directory (app:in-data-path "**/" "tiles/"))))
(when directories
(let ((p (search "tiles/" (namestring (first directories)) :from-end t)))
(flet ((add-string (str)
(write-sequence (x:string-to-bytes str) out))
(sep ()
(write-byte #.(char-code #\|) out)))
(dolist (dir directories)
(add-string (subseq (namestring dir) p))
(sep))
(let ((files (directory (app:in-data-path "**/*.*" "tiles/"))))
(dolist (file files)
(with-open-file (in file :element-type (stream-element-type out))
(add-string (subseq (namestring file) p))
(sep)
(add-string (princ-to-string (file-length in)))
(sep)
(copy-stream in out))))))))))
(defun extract-map-bin (&optional delete)
"Restores tiles from a previously saved single binary file named 'map.bin'."
(let ((blob (app:in-data-path app:*backup-map-file* "")))
(when (probe-file blob)
(with-open-file (in blob :element-type '(unsigned-byte 8))
(flet ((read-string ()
(let ((bytes (loop :for byte = (read-byte in nil nil)
:while (and byte (/= byte #.(char-code #\|)))
:collect byte)))
(if bytes
(x:bytes-to-string bytes)
(progn
(when delete
(close in)
(delete-file blob))
(return-from extract-map-bin))))))
(loop
(let ((name (app:in-data-path (read-string) "")))
(if (cl-fad:directory-pathname-p name)
(ensure-directories-exist name)
(let ((size (parse-integer (read-string))))
(with-open-file (out name :direction :output :if-exists :supersede
:element-type (stream-element-type in))
(copy-stream in out size)))))))))))