From 1cfa8612b9f34f573ac157ca4ad4e14fd2f6e8b4 Mon Sep 17 00:00:00 2001
From: nvhaizi1 <t412166221@163.com>
Date: Thu, 2 Jun 2022 08:50:17 +0800
Subject: [PATCH] =?UTF-8?q?=E5=86=99bus=5Fquery=5Ft=20*SSTFGetQuery?=
 =?UTF-8?q?=E5=87=BD=E6=95=B0?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 src/controller.c | 56 +++++++++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 55 insertions(+), 1 deletion(-)

diff --git a/src/controller.c b/src/controller.c
index 889c829..d83fb05 100644
--- a/src/controller.c
+++ b/src/controller.c
@@ -71,7 +71,61 @@ bus_query_t *FCFSQuery()
 
 bus_query_t *SSTFGetQuery()
 {
-    return NULL;
+    int a,b,length,min=10;//最多有10个站点
+    a = the_bus->rail_node_pos->id;  //是当前公交车的位置，而不是站点位置
+    b=rails->last_node->id;//总的站点数
+    if (1 <= a <= b/2)
+    {
+        if(abs(a+b-queries->node->id) < abs(a-queries->node->id) ) 
+        {
+            min=abs(a+b-queries->node->id);
+        }
+        else
+        {
+            min=abs(a-queries->node->id);
+        }
+    }
+    else if (b/2 < a <=b)
+    {
+        if (abs(queries->node->id+b-a)<abs(a-queries->node->id))
+        {
+            min=abs(queries->node->id+b-a);
+        }
+        else
+        {
+            min=abs(a-queries->node->id);
+        }
+    }
+    bus_query_t *p =queries->next_node;
+    bus_query_t *result=NULL;
+    while(queries->time != bus_time)
+    {
+        if (1 <= a <= b/2)
+        {
+            if(abs(a+b-p->node->id) <= abs(a-p->node->id) ) 
+            {
+                if(min >=abs(a+b-p->node->id))
+                {
+                    min=abs(a+b-p->node->id);
+                    result=p;
+                    p=p->next_node;
+                }
+            }
+        }
+        else if (b/2 < a <=b)
+        {
+            if (abs(p->node->id+b-a) <= abs(a-p->node->id))
+            {
+                if (min >= abs(p->node->id+b-a))
+                {
+                    min=abs(p->node->id+b-a);
+                    result=p;
+                    p=p->next_node;
+                }
+            }
+        }
+    }
+    return result;
 }
 
 int SSTFDirection(bus_query_t* query)