设为首页收藏本站
首页 > 论坛 > 行空板

[M10项目]小小屏幕也能接收行空板视频车图传 精华

云天 | 初级技神 | 创造力： | 帖子： | 发消息 | 串个门 | 加好友 | 打招呼
2023-1-13 19:25:24 [显示全部楼层]
2761浏览
6回复
2收藏
查看: 2761|回复: 6

[M10项目] 小小屏幕也能接收行空板视频车图传

[复制链接]
小小屏幕也能接收行空板视频车图传图1


【项目背景】

前两天收到了”鳄霸王“，第一感觉它是一个带屏幕的遥控器，只是这个屏幕有点太小了，128*64，黑白屏。

既然像遥控器，那就把它做成遥控器，屏幕虽小，但也可以显示视频车的图传实时环境图像。


小小屏幕也能接收行空板视频车图传图2


小小屏幕也能接收行空板视频车图传图3

【演示视频】

先上演示视频


【准备工作】

1、获取摇杆信息

小小屏幕也能接收行空板视频车图传图4

小小屏幕也能接收行空板视频车图传图5

2、”鳄霸王“获取图传图像

行空板python程序

  1. 

  2. def main():

  3.  import cv2

  4.  import numpy as np

  5.  import socket

  6.  import time

  7.  import binascii

  8.  import socket

  9.  import time

  10.  cap = cv2.VideoCapture(0)

  11.  cap.set(cv2.CAP_PROP_FRAME_WIDTH, 320)

  12.  cap.set(cv2.CAP_PROP_FRAME_HEIGHT, 240)

  13.  cap.set(cv2.CAP_PROP_BUFFERSIZE, 1)

  14.  cv2.namedWindow('car',cv2.WND_PROP_FULLSCREEN)    #Set the windows to be full screen.

  15.  cv2.setWindowProperty('car', cv2.WND_PROP_FULLSCREEN, cv2.WINDOW_FULLSCREEN)    #Set the windows to be full screen.

  16.  W=128

  17.  H=64

  18.  size = (W,H)

  19.  val=0

  20.  str1=''

  21.  while(1): # get a frame and show 

  22.     ret, frame1 = cap.read()

  23.     if(ret):

  24.         frame2=frame1.copy()

  25.         frame1 = cv2.resize(frame1, size)

  26.         

  27.         gray1 = cv2.cvtColor(frame1, cv2.COLOR_BGR2GRAY)

  28.         

  29.         BIN1= cv2.adaptiveThreshold(gray1,1,cv2.ADAPTIVE_THRESH_MEAN_C,cv2.THRESH_BINARY,7,3)

  30.         frame2 = cv2.rotate(frame2, cv2.ROTATE_90_COUNTERCLOCKWISE)

  31.         cv2.imshow('car', frame2)

  32.         

  33.         str1=""

  34.         for h in range(H):

  35.           for w in range(0,W,16):

  36.              for i in range(4):

  37.                   val=(int(BIN1[h][w+i*4+0])*8 + int(BIN1[h][w+i*4+1])*4 + int(BIN1[h][w+i*4+2])*2 + int(BIN1[h][w+i*4+3])*1)

  38.                   if val>=10:

  39.                     if val == 10:

  40.                       str1=str1+'A'

  41.                     if val==11:

  42.                       str1=str1+'B'

  43.                     if val==12:

  44.                       str1=str1+'C'

  45.                     if val==13:

  46.                       str1=str1+'D'

  47.                     if val==14:

  48.                       str1=str1+'E'

  49.                     if val==15:

  50.                       str1=str1+'F'

  51.                   else:

  52.                       str1=str1+str(val)

  53.              str1=str1+" "

  54.         #print(str1)

  55.         s=socket.socket(socket.AF_INET, socket.SOCK_STREAM)

  56.         s.connect(('192.168.31.216',10000))

  57.         s.send(bytearray.fromhex(str1))

  58.         time.sleep(0.19)

  59.         if cv2.waitKey(1) & 0xFF == ord('q'):

  60.          break

  61.  cv2.destroyAllWindows()

  62. if __name__=='__main__':

  63.     main()

复制代码
掌控板程序
  1. 

  2. 

  3. from mpython import *

  4. import usocket

  5. import network

  6. 

  7. my_wifi = wifi()

  8. my_wifi.connectWiFi("yuntian","yuntian123456")

  9. while not my_wifi.sta.isconnected():

  10.      pass

  11. 

  12. 

  13. oled.fill(0)

  14. oled.DispChar(my_wifi.sta.ifconfig()[0], 0, 0, 1)

  15. oled.show()

  16. 

  17. 

  18. #socket.socket() 创建了一个 socket 对象，并且支持 context manager type，你可以使用 with 语句，这样你就不用再手动调用 s.close() 来关闭 socket 了

  19. s=usocket.socket(usocket.AF_INET,usocket.SOCK_STREAM)

  20. #bind() 方法的入参取决于 socket 的地址族，在这个例子中我们使用了 socket.AF_INET (IPv4)，它接收一个二元组(host, port)入参

  21. #端口号应该是 1-65535 之间的整数（0是保留的），这个整数就是用来接受客户端链接的 TCP 端口号，如果端口号小于 1024，有的操作系统会要求管理员权限

  22. s.bind((my_wifi.sta.ifconfig()[0],10000))

  23. #listen() 方法调用使服务器可以接受连接请求，这使它成为一个「监听中」的 socket

  24. #listen() 方法有一个 backlog 参数。它指定在拒绝新的连接之前系统将允许使用的 未接受的连接 数量。从 Python 3.5 开始，这是可选参数。如果不指定，Python 将取一个默认值

  25. s.listen(5)

  26. 

  27. while True:

  28.       #accept() 方法阻塞并等待传入连接。当一个客户端连接时，它将返回一个新的 socket 对象，对象中有表示当前连接的 conn 和一个由主机、端口号组成的 IPv4/v6 连接的元组

  29.       con=s.accept()[0]

  30.       data=con.recv(1024)

  31.       #framebuf.FrameBuffer(buffer, width, height, format) 可以构建帧缓存对象， buffer 为缓存区数据，width 为图片宽度，height 为图片高度，format 为FrameBuffer的格式，即对应图片取模时数据输出的扫描模式：framebuf.MONO_HLSB 为水平方向；framebuf.MONO_VLSB 为垂直方向。

  32.       fbuf=framebuf.FrameBuffer(bytearray(data),128,64,framebuf.MONO_HLSB)

  33.       oled.fill(0)

  34.       #oled.blit(fbuf, x, y) 使用OLED显示图片帧，fbuf 为FrameBuffer对象，x 、y 为起始点的坐标x、y。

  35.       oled.blit(fbuf,0,0)

  36.       oled.show()

  37.       con.close()

  38. 

复制代码
利用电脑先进行测试
小小屏幕也能接收行空板视频车图传图6

行空板视频车
小小屏幕也能接收行空板视频车图传图7

3、控制行空板视频车运动
开启行空板siot
小小屏幕也能接收行空板视频车图传图8
行空板视频车Python程序
  1. 

  2. from pinpong.board import Board

  3. from microbit_motor import Microbit_Motor #导入Microbit_Motor库

  4. import siot

  5. from pinpong.extension.unihiker import *

  6. 

  7. from unihiker import GUI

  8. u_gui=GUI()

  9. xianshi=u_gui.draw_text(text="开始",x=50,y=100,font_size=50, color="#0000FF")

  10. # 事件回调函数

  11. def on_message_callback(client, userdata, msg):

  12.   

  13.   if (msg.payload.decode("utf-8")  == 'G'):

  14.       forward(200)

  15.       xianshi.config(text="前进")

  16.   if (msg.payload.decode("utf-8")== 'S'):

  17.       stop()

  18.       xianshi.config(text="停止")   

  19.       

  20.   if (msg.payload.decode("utf-8") == 'B'):

  21.       back(200)

  22.       xianshi.config(text="后退")  

  23.       

  24.   if (msg.payload.decode("utf-8") == 'L'):

  25.       left(200)

  26.       xianshi.config(text="向左")  

  27.       

  28.   if (msg.payload.decode("utf-8") == 'R'):

  29.       right(200)

  30.       xianshi.config(text="向右")

  31. 

  32. siot.init(client_id="siot_192",server="192.168.31.8",port=1883,user="siot",password="dfrobot")

  33. siot.connect()

  34. siot.loop()

  35. siot.set_callback(on_message_callback)

  36. siot.getsubscribe(topic="car/control")

  37. 

  38. Board("microbit").begin()

  39. motorbit = Microbit_Motor()

  40. def forward(speed):

  41.   #前进

  42.   #电机有M1,M2,M3,M4, CW代表正转，CCW代表反转，255是速度，范围0-255

  43.   if speed>255:

  44.       speed=255

  45.   motorbit.motor_run(motorbit.M1, motorbit.CW, speed)

  46.   motorbit.motor_run(motorbit.M2, motorbit.CW, speed)

  47.   motorbit.motor_run(motorbit.M3, motorbit.CCW, speed)

  48.   motorbit.motor_run(motorbit.M4, motorbit.CCW, speed)

  49. def back(speed):

  50.   #后退

  51.   #电机有M1,M2,M3,M4, CW代表正转，CCW代表反转，255是速度，范围0-255

  52.   if speed>255:

  53.       speed=255

  54.   motorbit.motor_run(motorbit.M1, motorbit.CCW, speed)

  55.   motorbit.motor_run(motorbit.M2, motorbit.CCW, speed)

  56.   motorbit.motor_run(motorbit.M3, motorbit.CW, speed)

  57.   motorbit.motor_run(motorbit.M4, motorbit.CW, speed)

  58. def left_turn(speed):

  59.   #向左转

  60.   #电机有M1,M2,M3,M4, CW代表正转，CCW代表反转，255是速度，范围0-255

  61.   if speed>255:

  62.       speed=255

  63.   motorbit.motor_run(motorbit.M1, motorbit.CW, speed)

  64.   motorbit.motor_run(motorbit.M2, motorbit.CW, speed)

  65.   motorbit.motor_run(motorbit.M3, motorbit.CW, speed)

  66.   motorbit.motor_run(motorbit.M4, motorbit.CW, speed)

  67. def right_turn(speed):

  68.   #向右转

  69.   #电机有M1,M2,M3,M4, CW代表正转，CCW代表反转，255是速度，范围0-255

  70.   if speed>255:

  71.       speed=255

  72.   motorbit.motor_run(motorbit.M1, motorbit.CCW, speed)

  73.   motorbit.motor_run(motorbit.M2, motorbit.CCW, speed)

  74.   motorbit.motor_run(motorbit.M3, motorbit.CCW, speed)

  75.   motorbit.motor_run(motorbit.M4, motorbit.CCW, speed)

  76. def left(speed):

  77.   #向左

  78.   #电机有M1,M2,M3,M4, CW代表正转，CCW代表反转，255是速度，范围0-255

  79.   if speed>255:

  80.       speed=255

  81.   motorbit.motor_run(motorbit.M1, motorbit.CW, speed)

  82.   motorbit.motor_run(motorbit.M2, motorbit.CCW, speed)

  83.   motorbit.motor_run(motorbit.M3, motorbit.CW, speed)

  84.   motorbit.motor_run(motorbit.M4, motorbit.CCW, speed)

  85. def right(speed):

  86.   #向右

  87.   #电机有M1,M2,M3,M4, CW代表正转，CCW代表反转，255是速度，范围0-255

  88.   if speed>255:

  89.       speed=255

  90.   motorbit.motor_run(motorbit.M1, motorbit.CCW, speed)

  91.   motorbit.motor_run(motorbit.M2, motorbit.CW, speed)

  92.   motorbit.motor_run(motorbit.M3, motorbit.CCW, speed)

  93.   motorbit.motor_run(motorbit.M4, motorbit.CW, speed)

  94. def stop():

  95.   motorbit.motor_stop(motorbit.M1)

  96.   motorbit.motor_stop(motorbit.M2)

  97.   motorbit.motor_stop(motorbit.M3)

  98.   motorbit.motor_stop(motorbit.M4)

复制代码
”鳄霸王“掌控板控制程序
小小屏幕也能接收行空板视频车图传图9
同micropython程序

  1. 

  2. # MindPlus

  3. # mpython

  4. from umqtt.simple import MQTTClient

  5. from mpython import *

  6. import network

  7. 

  8. 

  9. my_wifi = wifi()

  10. p0=MPythonPin(0,PinMode.ANALOG)

  11. p1=MPythonPin(1,PinMode.ANALOG)

  12. my_wifi.connectWiFi("yuntian","yuntian123456")

  13. while not (my_wifi.sta.isconnected()):

  14.   pass

  15. mqtt = MQTTClient("", "192.168.1.101", 1883, "siot", "dfrobot")

  16. try:

  17.   mqtt.connect()

  18.   print('MQTT Connected Successful')

  19. except:

  20.   print('MQTT Connection Failed')

  21. oled.DispChar(my_wifi.sta.ifconfig()[0], 42, 22, 1)

  22. oled.show()

  23. BiaoShi = 0

  24. while True:

  25.   if (p0.read_analog() < 10):

  26.     if (not (BiaoShi == 1)):

  27.       BiaoShi = 1

  28.       mqtt.publish(str("car/control"), str("G").encode('utf-8'))

  29.   elif (p0.read_analog() > 4000):

  30.     if (not (BiaoShi == 2)):

  31.       BiaoShi = 2

  32.       mqtt.publish(str("car/control"), str("B").encode('utf-8'))

  33.   elif (p1.read_analog() < 10):

  34.     if (not (BiaoShi == 3)):

  35.       BiaoShi = 3

  36.       mqtt.publish(str("car/control"), str("R").encode('utf-8'))

  37.   elif (p1.read_analog() > 4000):

  38.     if (not (BiaoShi == 4)):

  39.       BiaoShi = 4

  40.       mqtt.publish(str("car/control"), str("L").encode('utf-8'))

  41.   else:

  42.     if (not (BiaoShi == 5)):

  43.       mqtt.publish(str("car/control"), str("S").encode('utf-8'))

  44.       BiaoShi = 5

  45. 

复制代码
小小屏幕也能接收行空板视频车图传图10
【完整程序】
行空板视频车完整程序
  1. 

  2. 

  3. import cv2

  4. import numpy as np

  5. import socket

  6. import time

  7. import binascii

  8. import socket

  9. import time

  10. from pinpong.board import Board

  11. from dfrobot_motor import MOTOR

  12. import siot

  13. from pinpong.extension.unihiker import *

  14. 

  15. from unihiker import GUI

  16. u_gui=GUI()

  17. xianshi=u_gui.draw_text(text="开始",x=50,y=100,font_size=50, color="#0000FF")

  18. 

  19. def forward(speed):

  20.   

  21.   #前进

  22.   #电机有M1,M2, CW代表正转，CCW代表反转，255是速度，范围0-255

  23.   if speed>255:

  24.       speed=255

  25.   M.motor_run(M.ALL,M.CW,speed)

  26.   

  27. def back(speed):

  28.   #后退

  29.   #电机有M1,M2, CW代表正转，CCW代表反转，255是速度，范围0-255

  30.   if speed>255:

  31.       speed=255

  32.   M.motor_run(M.ALL,M.CCW,speed)

  33. def left_turn(speed):

  34.   #向左转

  35.   #电机有M1,M2, CW代表正转，CCW代表反转，255是速度，范围0-255

  36.   if speed>255:

  37.       speed=255

  38.   M.motor_run(M.M1,M.CW,speed)

  39.   M.motor_run(M.M2,M.CCW,speed)

  40. def right_turn(speed):

  41.   #向右转

  42.   #电机有M1,M2, CW代表正转，CCW代表反转，255是速度，范围0-255

  43.   if speed>255:

  44.       speed=255

  45.   M.motor_run(M.M1,M.CCW,speed)

  46.   M.motor_run(M.M2,M.CW,speed)

  47. 

  48. def stop():

  49.   M.motor_stop(M.ALL)

  50. # 事件回调函数

  51. def on_message_callback(client, userdata, msg):

  52.   

  53.   if (msg.payload.decode("utf-8")  == 'G'):

  54.       forward(200)

  55.       xianshi.config(text="前进")

  56.      

  57.   if (msg.payload.decode("utf-8")== 'S'):

  58.       stop()

  59.       xianshi.config(text="停止")   

  60.       

  61.   if (msg.payload.decode("utf-8") == 'B'):

  62.       back(200)

  63.       xianshi.config(text="后退")  

  64.       

  65.   if (msg.payload.decode("utf-8") == 'L'):

  66.       left_turn(200)

  67.       xianshi.config(text="向左")  

  68.       

  69.   if (msg.payload.decode("utf-8") == 'R'):

  70.       right_turn(200)

  71.       xianshi.config(text="向右")

  72. 

  73. siot.init(client_id="siot_192",server="192.168.1.101",port=1883,user="siot",password="dfrobot")

  74. siot.connect()

  75. siot.loop()

  76. siot.set_callback(on_message_callback)

  77. siot.getsubscribe(topic="car/control")

  78. Board().begin()

  79. M = MOTOR()

  80. 

  81. 

  82. cap = cv2.VideoCapture(0)

  83. cap.set(cv2.CAP_PROP_FRAME_WIDTH, 320)

  84. cap.set(cv2.CAP_PROP_FRAME_HEIGHT, 240)

  85. cap.set(cv2.CAP_PROP_BUFFERSIZE, 1)

  86. 

  87. W=128

  88. H=64

  89. size = (W,H)

  90. val=0

  91. str1=''

  92. while(1): # get a frame and show 

  93.     ret, frame1 = cap.read()

  94.     if(ret):

  95.         

  96.         frame1 = cv2.resize(frame1, size)

  97.         

  98.         gray1 = cv2.cvtColor(frame1, cv2.COLOR_BGR2GRAY)

  99.         

  100.         BIN1= cv2.adaptiveThreshold(gray1,1,cv2.ADAPTIVE_THRESH_MEAN_C,cv2.THRESH_BINARY,7,3)

  101.         

  102.         

  103. 

  104.         str1=""

  105.         for h in range(H):

  106.           for w in range(0,W,16):

  107.              for i in range(4):

  108.                   val=(int(BIN1[h][w+i*4+0])*8 + int(BIN1[h][w+i*4+1])*4 + int(BIN1[h][w+i*4+2])*2 + int(BIN1[h][w+i*4+3])*1)

  109.                   if val>=10:

  110.                     if val == 10:

  111.                       str1=str1+'A'

  112.                     if val==11:

  113.                       str1=str1+'B'

  114.                     if val==12:

  115.                       str1=str1+'C'

  116.                     if val==13:

  117.                       str1=str1+'D'

  118.                     if val==14:

  119.                       str1=str1+'E'

  120.                     if val==15:

  121.                       str1=str1+'F'

  122.                   else:

  123.                       str1=str1+str(val)

  124.              str1=str1+" "

  125.         #print(str1)

  126.         s=socket.socket(socket.AF_INET, socket.SOCK_STREAM)

  127.         s.connect(('192.168.1.100',10000))

  128.         s.send(bytearray.fromhex(str1))

  129.         time.sleep(0.19)

  130. 

  131. cv2.destroyAllWindows()

  132. 

复制代码


”鳄霸王“掌控板完整程序
  1. 

  2. from mpython import *

  3. import usocket

  4. import network

  5. from umqtt.simple import MQTTClient

  6. my_wifi = wifi()

  7. my_wifi.connectWiFi("yuntian","yuntian123456")

  8. while not my_wifi.sta.isconnected():

  9.      pass

  10. 

  11. p0=MPythonPin(0,PinMode.ANALOG)

  12. p1=MPythonPin(1,PinMode.ANALOG)

  13. mqtt = MQTTClient("", "192.168.1.101", 1883, "siot", "dfrobot")

  14. try:

  15.   mqtt.connect()

  16.   print('MQTT Connected Successful')

  17. except:

  18.   print('MQTT Connection Failed')

  19. oled.fill(0)

  20. oled.DispChar(my_wifi.sta.ifconfig()[0], 0, 0, 1)

  21. oled.show()

  22. BiaoShi = 0

  23. 

  24. #socket.socket() 创建了一个 socket 对象，并且支持 context manager type，你可以使用 with 语句，这样你就不用再手动调用 s.close() 来关闭 socket 了

  25. s=usocket.socket(usocket.AF_INET,usocket.SOCK_STREAM)

  26. #bind() 方法的入参取决于 socket 的地址族，在这个例子中我们使用了 socket.AF_INET (IPv4)，它接收一个二元组(host, port)入参

  27. #端口号应该是 1-65535 之间的整数（0是保留的），这个整数就是用来接受客户端链接的 TCP 端口号，如果端口号小于 1024，有的操作系统会要求管理员权限

  28. s.bind((my_wifi.sta.ifconfig()[0],10000))

  29. #listen() 方法调用使服务器可以接受连接请求，这使它成为一个「监听中」的 socket

  30. #listen() 方法有一个 backlog 参数。它指定在拒绝新的连接之前系统将允许使用的 未接受的连接 数量。从 Python 3.5 开始，这是可选参数。如果不指定，Python 将取一个默认值

  31. s.listen(5)

  32. 

  33. while True:

  34.       #accept() 方法阻塞并等待传入连接。当一个客户端连接时，它将返回一个新的 socket 对象，对象中有表示当前连接的 conn 和一个由主机、端口号组成的 IPv4/v6 连接的元组

  35.       con=s.accept()[0]

  36.       data=con.recv(1024)

  37.       #framebuf.FrameBuffer(buffer, width, height, format) 可以构建帧缓存对象， buffer 为缓存区数据，width 为图片宽度，height 为图片高度，format 为FrameBuffer的格式，即对应图片取模时数据输出的扫描模式：framebuf.MONO_HLSB 为水平方向；framebuf.MONO_VLSB 为垂直方向。

  38.       fbuf=framebuf.FrameBuffer(bytearray(data),128,64,framebuf.MONO_HLSB)

  39.       oled.fill(0)

  40.       #oled.blit(fbuf, x, y) 使用OLED显示图片帧，fbuf 为FrameBuffer对象，x 、y 为起始点的坐标x、y。

  41.       oled.blit(fbuf,0,0)

  42.       oled.show()

  43.       con.close()

  44.       if (p0.read_analog() < 10):

  45.           if (not (BiaoShi == 1)):

  46.                BiaoShi = 1

  47.                mqtt.publish(str("car/control"), str("G").encode('utf-8'))

  48.       elif (p0.read_analog() > 4000):

  49.           if (not (BiaoShi == 2)):

  50.                BiaoShi = 2

  51.                mqtt.publish(str("car/control"), str("B").encode('utf-8'))

  52.       elif (p1.read_analog() < 10):

  53.           if (not (BiaoShi == 3)):

  54.                BiaoShi = 3

  55.                mqtt.publish(str("car/control"), str("R").encode('utf-8'))

  56.       elif (p1.read_analog() > 4000):

  57.           if (not (BiaoShi == 4)):

  58.                BiaoShi = 4

  59.                mqtt.publish(str("car/control"), str("L").encode('utf-8'))

  60.       else:

  61.           if (not (BiaoShi == 5)):

  62.                mqtt.publish(str("car/control"), str("S").encode('utf-8'))

  63.                BiaoShi = 5

  64. 

复制代码

附件： dfrobot_motor.py需拷贝到行空板，与程序在同一目录
下载附件dfrobot_motor.zip



回复

使用道具 举报

精彩评论(6)

花生编程  中级技匠

发表于 2023-1-14 08:36:53

厉害厉害
回复

使用道具 举报

花生编程  中级技匠

发表于 2023-1-14 08:40:44

赞！！
回复

使用道具 举报

34603471  初级技师

发表于 2023-1-14 10:50:57

小小掌控，大大用处，掌控板行空板yyds!赞一个！
回复

使用道具 举报

rzyzzxw  版主

发表于 2023-1-15 11:26:55

确实厉害
回复

使用道具 举报

easylot  初级技师 来自手机

发表于 2023-11-3 10:03:02

太牛了
回复

使用道具 举报

曾剑波  初级技匠

发表于 2023-11-13 13:17:08

这个不错！值得学习！其实很多都是基于基础知识，就是实战应用场景切入而已
回复

使用道具 举报

高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

为本项目制作心愿单
购买心愿单
心愿单 编辑
[[wsData.name]]

硬件清单

  • [[d.name]]
btnicon
我也要做!
点击进入购买页面
撰写新帖
关于楼主
勋章墙
活跃会员 宣传大使 创客造 编辑选择奖 志“童”道合 编辑选择奖 编辑选择奖

楼主的其它帖子

background 创造力兑换 background 心愿单 background 创客导航
上海智位机器人股份有限公司 沪ICP备09038501号-4

© 2013-2024 Comsenz Inc. Powered by Discuz! X3.4 Licensed

mail