mirror of
https://gitlab.com/eql/lqml.git
synced 2025-12-06 18:40:56 -08:00
22 lines
713 B
Common Lisp
22 lines
713 B
Common Lisp
(in-package :gps)
|
|
|
|
(defvar *distance-samples* 5)
|
|
|
|
(let ((speed 0.0)
|
|
samples)
|
|
(defun update-speed ()
|
|
"After *DISTANCE-SAMPLES* samples, calculate average speed and update on
|
|
every new distance sample."
|
|
(push (cons (distance)
|
|
(/ (get-internal-real-time) 1000.0))
|
|
samples)
|
|
(when (> (length samples) *distance-samples*)
|
|
(setf samples (butlast samples))
|
|
(let ((b (first samples))
|
|
(a (first (last samples))))
|
|
(setf speed (* 3.6 ; km/h
|
|
(/ (- (car b) (car a)) ; m
|
|
(/ (- (cdr b) (cdr a)) ; s
|
|
1000.0)))))))
|
|
(defun speed* ()
|
|
speed))
|