post-guard/auto_bus
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

写SSTFDirection函数

Browse Source
This commit is contained in:
nvhaizi1 2022-06-02 09:37:29 +08:00
parent 2459ccb8f5
commit 2213147bee
1 changed files with 14 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
src/controller.c
View File

@ -2,6 +2,7 @@
// Created by ricardo on 2022/5/6. // Created by ricardo on 2022/5/6.
// //
#include "controller.h" #include "controller.h"
#include "math.h"
bus_query_t *target_query = NULL; bus_query_t *target_query = NULL;
int chosen_strategy = -1; int chosen_strategy = -1;
@ -72,11 +73,11 @@ bus_query_t *FCFSQuery()
bus_query_t *SSTFGetQuery() bus_query_t *SSTFGetQuery()
{ {
int a,b,length,min; int a,b,length,min;
a = the_bus->rail_node_pos->id; //是当前公交车的位置，而不是站点位置 a = the_bus->rail_node_pos->id; //是当前公交车的位置，而不是站点位置，应该两者差别不大
b = rails->last_node->id;//总的站点数 b = rails->last_node->id;//总的站点数
if (1 <= a <= b/2) if (1 <= a <= b/2)//判断当前站点的位置
{ {
if (abs(a+b-queries->node->id) < abs(a-queries->node->id) ) if (abs(a+b-queries->node->id) < abs(a-queries->node->id) ) //因为是环形轨道，用id相减的方式来计算距离的话，相减的方法不同
{ {
min = abs(a+b-queries->node->id); min = abs(a+b-queries->node->id);
} }
@ -131,7 +132,17 @@ bus_query_t *SSTFGetQuery()
int SSTFDirection(bus_query_t* query) int SSTFDirection(bus_query_t* query)
{ {
if (query != NULL)
{
if (query->type != BUS_TARGET )
{
return query->type;
}
}
else
{
return BUS_STOP; return BUS_STOP;
}
} }
bus_query_t *SSTFBTWQuery() bus_query_t *SSTFBTWQuery()