#pragma once
#include "SimpleStrange.h"

double Distance (Vector3D pos1,Vector3D pos2); //計算兩點之間的距離
double Cut(double num,double down,double up);
long Cut(long num,long down,long up);
void NormalAngle(double &angle);
int toint(double num);
double Atan(double y,double x);
double Atan(Vector3D begin,Vector3D end);
double VelocityOne(double speed,double vl,double vr);		/// speed 以和robot同向為正
double AngleOne(double omiga,double vl,double vr);
Speed operator -(Vector3D &v1,Vector3D &v2);
double Atan(Vector3D begin,Vector3D end);
double meet_y(Vector3D p1,Vector3D p2,double x);
double meet_y(Vector3D p,double z,double x);