opencv画火车沿轨道运行-课程作业

最新推荐文章于 2024-05-21 18:05:11 发布
最新推荐文章于 2024-05-21 18:05:11 发布
阅读量251 收藏 3
点赞数
文章标签： opencv
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/blue_can/article/details/115329343
版权

opencv画火车沿轨道运行-课程作业

写本次博客的目的主要是记录自己的成果，有什么不足欢迎指教。

四个函数，一个循环

一、 轨道函数

#定义轨道函数
def func_2(x):
    if x>0 and x<=50:
        y = 400
    elif x>50 and x<=250:
        y = math.ceil((400**2-(x-50)**2)**0.5)
    elif x>250 and x<=350:
        y = math.floor(-((3**0.5)*x)/3+850*(3**0.5)/3)
    elif x>350 and x<=550:
        y = math.floor(-(400**2-(x-550)**2)**0.5+1100*(3**0.5)/3)
    else:
        y = math.floor(1100*(3**0.5)/3-400)
    return y

#定义轨道函数，另一种表现形式
def func_0(x):
    interval0 = 1 if x>0 and x<=50 else 0
    interval1 = 1 if x>50 and x<250 else 0
    interval2 = 1 if x == 250 else 0
    interval3 = 1 if x>250 and x<=450 else 0
    interval4 = 1 if x>450 and x<=500 else 0
    #y = 500*interval0 + 400*interval1 + 300*interval2 + 200*interval3 + 100*interval4
    y =500*interval0 + ((200**2-(x-50)**2)**0.5+300)*interval1 +300*interval2 + (-(200**2-(x-450)**2)**0.5+250)*interval3 + 50*interval4
    return y

二、定义可转弯小车的方法

#定义一个画可转弯小车的方法
def draw(canvas,result):
    result=np.array(result)
    x = result[0]
    y = result[1]
    angle = result[2]
    height = result[3]
    width = result[4]

    angle_Pi = -angle*math.pi/180.0 #转化为弧度
    cosA = math.cos(angle_Pi)
    sinA = math.sin(angle_Pi)

    x1 = x-0.5*width
    y1 = y-0.5*height
    
    x0 = x+0.5*width
    y0 = y1
    
    x2 = x1
    y2 = y+0.5*height

    x3=x0
    y3=y2

    x0n = math.floor((x0 - x)*cosA - (y0 - y)*sinA + x)
    y0n = math.floor((x0 - x)*sinA + (y0 - y)*cosA + y)
    
    x1n = math.floor((x1 - x)*cosA - (y1 - y)*sinA + x)
    y1n = math.floor((x1 - x)*sinA + (y1 - y)*cosA + y)

    x2n = math.floor((x2 - x)*cosA - (y2 - y)*sinA + x)
    y2n = math.floor((x2 - x)*sinA + (y2 - y)*cosA + y)

    x3n = math.floor((x3 - x)*cosA - (y3 - y)*sinA + x)
    y3n = math.floor((x3 - x)*sinA + (y3 - y)*cosA + y)

    cv2.line(canvas,(x0n, y0n),(x1n, y1n), (255, 0, 0))
    cv2.line(canvas,(x1n, y1n),(x2n, y2n), (255, 0, 0))
    cv2.line(canvas,(x2n, y2n),(x3n, y3n), (255, 0, 0))
    cv2.line(canvas,(x0n, y0n),(x3n, y3n), (255, 0, 0))

可以把小车看出一个矩形，小车在轨道上运行时，是需要不断转弯的。由于当时用opencv画的，不知道哪种方法可以直接画旋转矩形（后面知道一种方法可以不断框四个点的最小矩形，也能实现），因此必须自己定义一个。
此处写函数的思路是借鉴大佬的方法写的，稍微改了一下，使它与我的代码更加兼容。

参考 https://blog.csdn.net/u013948010/article/details/78318894

三、定义角度函数

def func_angle(x):
    if x >0 and x<=50:
        ang = 0
    elif x>50 and x<=250:
        ang = -math.floor(math.atan(((400**2-(x-50)**2)**0.5-(400**2-(x-1-50)**2)**0.5))*180/math.pi)
    elif x>=250 and x<=350:
        ang = 30
    elif x>350 and x<=550:
        ang = -math.floor(math.atan((-(400**2-(x-550)**2)**0.5+1100*(3**0.5)/3)-(-(400**2-(x-1-550)**2)**0.5+1100*(3**0.5)/3))*180/math.pi)
    else:
        ang = 0
    return ang

目的使小车在沿轨道运行的过程中能不断的改变角度。

四、定义约束项

def lim(distance):#约束项
    x = 0
    for i in range(8,830):
        if (power_3-i)**2 + (func_2(power_3)-func_2(i))**2 <= (distance+1)**2 and (power_3-i)**2 + (func_2(power_3)-func_2(i))**2 >= (distance-1)**2:
            if i < power_3 and i >= power_3 - 11:
                x = i
    return x

定义这个函数的目的就是使两个小车之间的连杆距离保持不变。

五、一个循环

while True:
    power_4 = power_5-8 #34
    power_3 = power_4-4 #30
    power_2 = lim(10) #20
    power_1 = power_2-4 #16
    power_0 = power_1-8 #8
    power_6 = power_2-8 #12
    power_7 = power_5-4 #38
#建立一个背景画布
    canvas = np.ones((600,800,3),dtype = 'uint8') #dtype选择 uint8 是为了方便显示图像(0-255)
    canvas = canvas*255
#画一条红色直线
    red = (0,0,255) #opencv 里面是BGR顺序，不同于常见的RGB顺序
    cv2.line(canvas,(0,400),(50,400),red)
#画圆
    black = (0,0,0)
    (center0_x,center0_y) = (50,0)
    cv2.ellipse(canvas,(center0_x,center0_y),(400,400),0,60,90,black)
#画直线
    cv2.line(canvas,(250,math.floor(200*(3**0.5))),(350,math.floor(500*(3**0.5)/3)),red)
#画圆
    cv2.ellipse(canvas,(550,math.floor(1100*(3**0.5)/3)),(400,400),0,240,270,black)
#画直线
    cv2.line(canvas,(550,math.floor(1100*(3**0.5)/3)-400),(650,math.floor(1100*(3**0.5)/3)-400),red)
    g = (0,255,0)
    b_g = (255,255,0)
#画移动的圆心
    cv2.circle(canvas,(power_0,func_2(power_0)),1,g,-1)
    cv2.circle(canvas,(power_1,func_2(power_1)),1,g,-1)
    cv2.circle(canvas,(power_2,func_2(power_2)),1,g,-1)
    cv2.circle(canvas,(power_3,func_2(power_3)),1,g,-1)
    cv2.circle(canvas,(power_4,func_2(power_4)),1,g,-1)
    cv2.circle(canvas,(power_5,func_2(power_5)),1,g,-1)
#画移动的杆
    cv2.line(canvas,(power_2,func_2(power_2)),(power_3,func_2(power_3)),b_g,2)
#画移动的矩形
    draw(canvas,(power_6,func_2(power_6),func_angle(power_6),10,20))
    draw(canvas,(power_7,func_2(power_7),func_angle(power_7),10,20))
    cv2.imshow('train_game',canvas)
    power_5 += 1
    key = cv2.waitKey(40)
    if key == ord('1'):
        break
cv2.destroyAllWindows()
#cv2.imwrite('C:\\users\\lenovo\\csdn_dl\\test.png',canvas)

这一部分利用opencv自带的包，通过不断的调用函数，将坐标点导入画弧、直线等方法中。
power_0 power_1 … power_5 代表小车的车轮以及车钩。
power_6 power_7 代表小车的中心。
需要注意的是，opencv中画图的方法需要一个整型，因此函数算出来的坐标都是经过不断向下取整。最后实现起来并不是特别平滑。

以下附上总代码

#导入相关的包
import numpy as np
import cv2
import math
power_5 = 42

#定义坐标点函数
def func_2(x):
    if x>0 and x<=50:
        y = 400
    elif x>50 and x<=250:
        y = math.ceil((400**2-(x-50)**2)**0.5)
    elif x>250 and x<=350:
        y = math.floor(-((3**0.5)*x)/3+850*(3**0.5)/3)
    elif x>350 and x<=550:
        y = math.floor(-(400**2-(x-550)**2)**0.5+1100*(3**0.5)/3)
    else:
        y = math.floor(1100*(3**0.5)/3-400)
    return y

#定义坐标点函数
def func_0(x):
    interval0 = 1 if x>0 and x<=50 else 0
    interval1 = 1 if x>50 and x<250 else 0
    interval2 = 1 if x == 250 else 0
    interval3 = 1 if x>250 and x<=450 else 0
    interval4 = 1 if x>450 and x<=500 else 0
    #y = 500*interval0 + 400*interval1 + 300*interval2 + 200*interval3 + 100*interval4
    y =500*interval0 + ((200**2-(x-50)**2)**0.5+300)*interval1 +300*interval2 + (-(200**2-(x-450)**2)**0.5+250)*interval3 + 50*interval4
    return y

#定义一个画可旋转矩形的方法
def draw(canvas,result):
    result=np.array(result)
    x = result[0]
    y = result[1]
    angle = result[2]
    height = result[3]
    width = result[4]

    angle_Pi = -angle*math.pi/180.0 #转化为弧度
    cosA = math.cos(angle_Pi)
    sinA = math.sin(angle_Pi)

    x1 = x-0.5*width
    y1 = y-0.5*height
    
    x0 = x+0.5*width
    y0 = y1
    
    x2 = x1
    y2 = y+0.5*height

    x3=x0
    y3=y2

    x0n = math.floor((x0 - x)*cosA - (y0 - y)*sinA + x)
    y0n = math.floor((x0 - x)*sinA + (y0 - y)*cosA + y)
    
    x1n = math.floor((x1 - x)*cosA - (y1 - y)*sinA + x)
    y1n = math.floor((x1 - x)*sinA + (y1 - y)*cosA + y)

    x2n = math.floor((x2 - x)*cosA - (y2 - y)*sinA + x)
    y2n = math.floor((x2 - x)*sinA + (y2 - y)*cosA + y)

    x3n = math.floor((x3 - x)*cosA - (y3 - y)*sinA + x)
    y3n = math.floor((x3 - x)*sinA + (y3 - y)*cosA + y)

    cv2.line(canvas,(x0n, y0n),(x1n, y1n), (255, 0, 0))
    cv2.line(canvas,(x1n, y1n),(x2n, y2n), (255, 0, 0))
    cv2.line(canvas,(x2n, y2n),(x3n, y3n), (255, 0, 0))
    cv2.line(canvas,(x0n, y0n),(x3n, y3n), (255, 0, 0))

#定义角度
def func_angle(x):
    if x >0 and x<=50:
        ang = 0
    elif x>50 and x<=250:
        ang = -math.floor(math.atan(((400**2-(x-50)**2)**0.5-(400**2-(x-1-50)**2)**0.5))*180/math.pi)
    elif x>=250 and x<=350:
        ang = 30
    elif x>350 and x<=550:
        ang = -math.floor(math.atan((-(400**2-(x-550)**2)**0.5+1100*(3**0.5)/3)-(-(400**2-(x-1-550)**2)**0.5+1100*(3**0.5)/3))*180/math.pi)
    else:
        ang = 0
    return ang

def lim(distance):#约束项
    x = 0
    for i in range(8,830):
        if (power_3-i)**2 + (func_2(power_3)-func_2(i))**2 <= (distance+1)**2 and (power_3-i)**2 + (func_2(power_3)-func_2(i))**2 >= (distance-1)**2:
            if i < power_3 and i >= power_3 - 11:
                x = i
    return x

while True:
    power_4 = power_5-8 #34
    power_3 = power_4-4 #30
    power_2 = lim(10) #20
    power_1 = power_2-4 #16
    power_0 = power_1-8 #8
    power_6 = power_2-8 #12
    power_7 = power_5-4 #38
#建立一个背景画布
    canvas = np.ones((600,800,3),dtype = 'uint8') #dtype选择 uint8 是为了方便显示图像(0-255)
    canvas = canvas*255
#画一条红色直线
    red = (0,0,255) #opencv 里面是BGR顺序，不同于常见的RGB顺序
    cv2.line(canvas,(0,400),(50,400),red)
#画圆
    black = (0,0,0)
    (center0_x,center0_y) = (50,0)
    cv2.ellipse(canvas,(center0_x,center0_y),(400,400),0,60,90,black)
#画直线
    cv2.line(canvas,(250,math.floor(200*(3**0.5))),(350,math.floor(500*(3**0.5)/3)),red)
#画圆
    cv2.ellipse(canvas,(550,math.floor(1100*(3**0.5)/3)),(400,400),0,240,270,black)
#画直线
    cv2.line(canvas,(550,math.floor(1100*(3**0.5)/3)-400),(650,math.floor(1100*(3**0.5)/3)-400),red)
    g = (0,255,0)
    b_g = (255,255,0)
#画移动的圆心
    cv2.circle(canvas,(power_0,func_2(power_0)),1,g,-1)
    cv2.circle(canvas,(power_1,func_2(power_1)),1,g,-1)
    cv2.circle(canvas,(power_2,func_2(power_2)),1,g,-1)
    cv2.circle(canvas,(power_3,func_2(power_3)),1,g,-1)
    cv2.circle(canvas,(power_4,func_2(power_4)),1,g,-1)
    cv2.circle(canvas,(power_5,func_2(power_5)),1,g,-1)
#画移动的杆
    cv2.line(canvas,(power_2,func_2(power_2)),(power_3,func_2(power_3)),b_g,2)
#画移动的矩形
    draw(canvas,(power_6,func_2(power_6),func_angle(power_6),10,20))
    draw(canvas,(power_7,func_2(power_7),func_angle(power_7),10,20))
    cv2.imshow('train_game',canvas)
    power_5 += 1
    key = cv2.waitKey(40)
    if key == ord('1'):
        break
cv2.destroyAllWindows()
#cv2.imwrite('C:\\users\\lenovo\\csdn_dl\\test.png',canvas)

以下效果图

在这里插入图片描述
在这里插入图片描述

在这里插入图片描述
在这里插入图片描述

blue_can
关注
  • 0
    点赞
  • 踩
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
【opencv-python】 安装opencv-contrib-python
jn10010537的博客
06-25 1万+
安装opencv-contrib-python-1、背景-2、尝试conda直接安装-3、pip安装下载的whl文件 -1、背景 Repository for OpenCV’s extra modules. Contribute to opencv/opencv_contrib development by creating an account on GitHub.即opencv-contrib是OpenCV额外模块（扩展模块）。 对应的是opencv /opencv_contrib 可以认为是openc
python3.6下载opencv-python和opencv-contrib-python
qq_53545309的博客
01-11 4134
opencv安装
Unity轨道插件 Track
04-08
一款 Unity轨道插件，可以视图中自由编辑。
轨道线检测
qq_37464479的博客
07-22 801
该项目是作为自动列车交通的基础技术开发的，没有深度学习的视频中的铁路检测，只有与安装在列车前部的摄像头的轨道相对应的区域，用于自动列车系统检测铁轨的概念验证程序。代码下载code。...
unity插件 Tracks and Rails.unitypackage 铁路轨道生成
07-08
这个扩展允许您创建任何自定义形状的轨道，然后将一个购物车附加到它，并实际骑在轨道上。让平台在受到撞击时能滑动，地铁列车撞到障碍物，坏掉的电梯，过山车，看不见的飞行路线，火箭推进的火车等等! 网格是自动生成的。包括四个跟踪模板。用这些或者自己做。使用任何你想要的模型，或只是把相机放在它和去兜风! 是基于物理的相互作用。这辆车有一个刚体，可以像其他刚体一样被推、拉、撞、跳和加速。轨道本身可以被赋予加速度和刹车特性。使用包含的脚本，让您的购物车在路上滚动时发出声音。 使用脚本在运行时创建、链接和弯曲轨迹。建一个火车站或炸掉一座桥! 沉重的编辑器支持。快速跟踪铺设工具，直接控制点编辑，重新链接工具，撤消，和大规模编辑支持。
unity插件轨道
哲哲
06-26 2989
今天新学习了一个插件，把学到的经验告诉一下大家。 当我们倒进去这个插件的时候，他会里面出现这个东西，然后创建， 创建出来之后他会有一个红色和绿色的头。 在这里面他可以调节方向，长度。 红色的是尾部，绿色的是头。 当我们点击这个绿色的时候，他会自动创建一个你之前的一个铁路（铁路的形状是之前上一个铁路的形状） 不用复制，他会直接对接前一个铁路模型 这里面调节他的速度，（当给他赋值速度的时...
Unity学习笔记 Cinemachine沿着轨道自动匀速移动
Lawa0592的博客
02-14 7479
untiy cinemachine实现相机沿着轨道自动移动
OpenCV-Python实战（1）——OpenCV简介与图像处理基础
热门推荐
盼小辉丶的博客
08-10 21万+
OpenCV 是一个的跨平台计算机视觉库，可以运行在 Linux、Windows 和 Mac OS 操作系统上。它轻量级而且高效——由一系列 C 函数和少量 C++ 类构成，同时也提供了 Python 接口，实现了图像处理和计算机视觉方面的很多通用算法。在本文中，将介绍 OpenCV 库，包括它的主要模块和典型应用场景，同时使用 OpenCV-Python 实战讲解图像处理基础要点。
python3.7安装opencv python 和 opencv-contrib-python的相关问题
woshixiaobailys的博客
03-24 7309
由于3.4.2以上的opencv设计专利问题，有一些函数无法使用，所以我们要用更低版本，但是python3.6版本是没有办法下载3.4.1的opencv的，所以想要下载3.4.1版本首先要降低版本。我们主要围绕着python3.7来讨论一下 1 打开cmd直接 pip install opencv-python3.4.2.16 pip install opencv-contrib-python3....
opencv视觉导航小车寻迹
03-31
AGV视觉寻迹
unity铁路轨道生成系统源码
04-19
unity铁路轨道生成系统源码+Tracks+and+Rails.unitypackage
U3D轨道插件.rar
05-27
Curvy Splines v6.0.1版本，曲线插件，自动生成所需道路，赛道。unity3d曲线工具。道路自动生成工具。 资源名称: Curvy Splines v6.0.1 资源版本:v6.0.1 资源类型: .unitypackage 资源大小: 72.8 MB 支持版本:5.5.3 及以上版本
C++ OpenCV识别图像上的线条轨迹
琅嬛福地
02-13 1万+
如果图片上有线条，图形什么的，人的眼睛可以直接看出来，这是人的直接反应。那么如何让电脑识别呢？换个角度说，用户怎么教电脑去识别图片。 图片在内存中是以二维矩阵的形式存储的，如果是彩图，则是GBR三通道，灰度图则是单通道。本教程用OpenCV去识别图形上的线条，曲线等轨迹。 软件环境：Win7-32， VS2010， OpenCV2.4.9 （1）以灰度图的方式导入图片...
OpenCV中轨迹条的创建
SweetWind1996的博客
06-29 835
OpenCV中有自带的轨迹条创建函数createTrackbar()，如下：int cv::createTrackbar (const String &amp; trackbarname,   const String &amp; winname,   int * value,   int count,   TrackbarCallback onChange = 0,   void * userd...
unity实现根据路径生成贝塞尔曲线路径并且物体跟随路径移动
weixin_50768411的博客
05-21 1334
nity实现根据路径生成贝塞尔曲线路径并且物体跟着路径移动
Unity 车辆跟随路径点缓动移动
qq_52159742的博客
11-25 3848
public Transform[] ways1;//路径点的位置 public Transform[] ways; public Transform tagret;//移动的物体 public Transform Player; public float ZhuJueSpeed; private int index1, index; /// <summary> /// 玩家移动 /// </summary&gt...
unity3D 脚本2
helongss的博客
02-25 152
unity3D 脚本2
火车轨道铁路轨道检测识别（弯轨+直轨）通用性（Python源码+讲解）
幸福回头的博客
03-18 1万+
在前几天的文章中，对直线的铁轨可以实现检测，但是实际的过程中，火车的弯轨也是特别多，比如从北京-石家庄的铁路线路，弯路占到了70%以上的比例，所以对于铁轨的弯道检测，也是很重要的一块内容，在一段时间的研究下，终于实现了弯道铁轨的检测，同时也可以拟合S形的铁轨，并且检测速度可以实现实时性的要求，在接下来的工作中，我会把铁轨检测+YOLOv3移植到Jetson TX2+Intel NCS...
html5使用canvas的 bezierCurveTo()方法绘制地图轨迹曲线（三次贝塞尔曲线）
wxCSDN1997的博客
01-10 2351
参考：Canvas基于百度地图绘制流动曲线_清山博客-CSDN博客_百度地图流向图 <!DOCTYPE html> <html> <head> <meta http-equiv="Content-Type" content="text/html; charset=utf-8" /> <meta name="viewport" content="initial-scale=1.0, user-scalable=no" />
install opencv-pythonpip install opencv-contrib-python
最新发布
08-21
`opencv-python` 和 `opencv-contrib-python` 是两个不同的OpenCV库版本。`opencv-python` 包含了OpenCV的基本功能，而 `opencv-contrib-python` 则包含了更多扩展模块和实验性功能。 如果你想要安装OpenCV的基本库...
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值