A*-----第K短路

给定一张N个点（编号1,2…N），M条边的有向图，求从起点S到终点T的第K短路的长度，路径允许重复经过点或边。
注意： 每条最短路中至少要包含一条边。
输入格式
第一行包含两个整数N和M。
接下来M行，每行包含三个整数A,B和L，表示点A与点B之间存在有向边，且边长为L。
最后一行包含三个整数S,T和K，分别表示起点S，终点T和第K短路。
输出格式
输出占一行，包含一个整数，表示第K短路的长度，如果第K短路不存在，则输出“-1”。
数据范围
1≤S,T≤N≤10001≤S,T≤N≤1000,

0≤M≤1050≤M≤105,

1≤K≤10001≤K≤1000,

1≤L≤1001≤L≤100
输入样例：
2 2
1 2 5
2 1 4
1 2 2

输出样例：
14

#include <iostream>
#include <cstring>
#include <algorithm>
#include <queue>
#define x first
#define y second
using namespace std;
typedef pair<int, int> PII;
typedef pair<int, PII> PIII;
const int N = 1010, M = 200010;
int n, m, S, T, K;
int h[N], rh[N], e[M], w[M], ne[M], idx;
int dist[N];
int st[N];
void add(int h[], int a, int b, int c){
 e[idx] = b, w[idx] = c, ne[idx] = h[a], h[a] = idx ++;
}
void dijkstra(){
 priority_queue <PII, vector <PII>, greater <PII>>  heap;
  heap.push({0, T});
 memset(dist, 0x3f, sizeof dist);
 dist[T] = 0;
  while(heap.size()){
  auto t = heap.top();
  heap.pop();
  int ver = t.y;
  if(st[ver])   continue;
  st[ver] = true;
  for (int i = rh[ver]; ~i; i = ne[i]){
   int j = e[i];
   if (dist[j] > dist[ver] + w[i]){
    dist[j] = dist[ver] + w[i];
    heap.push({dist[j], j});
   }
  }
 }
}
int astar(){
 priority_queue <PIII, vector <PIII>, greater <PIII>> heap;
 heap.push({dist[S], {0, S}});
 memset (st, 0, sizeof st);
  while(heap.size()){
  auto t = heap.top();
  heap.pop();
  int ver = t.y.y, distance = t.y.x;
  st[ver] ++;
  if (ver == T && st[ver] == K)   return distance;
  for (int i = h[ver]; ~i; i = ne[i]){
   int j = e[i];
   heap.push({distance + w[i]+ dist[j], {distance + w[i], j}});
  }
 }
 return -1; 
}
int main()
{
    scanf("%d%d", &n, &m);
    memset(h, -1, sizeof h);
    memset(rh, -1, sizeof rh);
    for (int i = 0; i < m; i ++ )
    {
        int a, b, c;
        scanf("%d%d%d", &a, &b, &c);
        add(h, a, b, c);
        add(rh, b, a, c);
    }
  scanf("%d%d%d", &S, &T, &K);
    if (S == T) K ++ ;
dijkstra();
    printf("%d\n", astar());
    return 0;
}