SHOW:
|
|
- or go back to the newest paste.
| 1 | - | local robot = require("robot") |
| 1 | + | local movement={}
|
| 2 | - | |
| 2 | + | local robot = require("robot")
|
| 3 | - | -- Angles: 1=North; 2=West; 3=South; 4=East (Relative to robot placement! Faceing when placed will allways be North!). |
| 3 | + | |
| 4 | - | local angle = 1 |
| 4 | + | -- Angles: 1=North; 2=West; 3=South; 4=East (Relative to robot placement! Faceing when placed will allways be North!). |
| 5 | - | |
| 5 | + | local angle = 1 |
| 6 | - | -- tries to move the Robot forward by @times times, if there is a obstacle, swing the current Tool. |
| 6 | + | |
| 7 | - | function tryForward(times) |
| 7 | + | -- tries to move the Robot forward by @times times, if there is a obstacle, swing the current Tool. |
| 8 | - | for i=1, times do |
| 8 | + | function movement.tryForward(times) |
| 9 | - | while not robot.forward() do |
| 9 | + | for i=1, times do |
| 10 | - | robot.swing() |
| 10 | + | while not robot.forward() do |
| 11 | - | end |
| 11 | + | robot.swing() |
| 12 | - | end |
| 12 | + | end |
| 13 | - | end |
| 13 | + | end |
| 14 | - | |
| 14 | + | end |
| 15 | - | -- tries to move the Robot upwards by @times times, if there is an obstacle, swing the current Tool. |
| 15 | + | |
| 16 | - | function tryUp(times) |
| 16 | + | -- tries to move the Robot upwards by @times times, if there is an obstacle, swing the current Tool. |
| 17 | - | for i=1, times do |
| 17 | + | function movement.tryUp(times) |
| 18 | - | while not robot.up() do |
| 18 | + | for i=1, times do |
| 19 | - | robot.swingUp() |
| 19 | + | while not robot.up() do |
| 20 | - | end |
| 20 | + | robot.swingUp() |
| 21 | - | end |
| 21 | + | end |
| 22 | - | end |
| 22 | + | end |
| 23 | - | |
| 23 | + | end |
| 24 | - | --tries to move the Robot downwards by @times times, if there is an obstacle, swing the current Tool. |
| 24 | + | |
| 25 | - | function tryDown(times) |
| 25 | + | --tries to move the Robot downwards by @times times, if there is an obstacle, swing the current Tool. |
| 26 | - | for i=1, times do |
| 26 | + | function movement.tryDown(times) |
| 27 | - | while not robot.down() do |
| 27 | + | for i=1, times do |
| 28 | - | robot.swingDown() |
| 28 | + | while not robot.down() do |
| 29 | - | end |
| 29 | + | robot.swingDown() |
| 30 | - | end |
| 30 | + | end |
| 31 | - | end |
| 31 | + | end |
| 32 | - | |
| 32 | + | end |
| 33 | - | -- turns the robot by @degree times in the Direction of @dir<1=Left; 2=Right> |
| 33 | + | |
| 34 | - | -- Possible degrees: 1=90°; 2=180°; 3=270°; 4=360°; 5=450°... |
| 34 | + | -- turns the robot by @degree times in the Direction of @dir<1=Left; 2=Right> |
| 35 | - | -- keeps track of the robots current Angle. |
| 35 | + | -- Possible degrees: 1=90°; 2=180°; 3=270°; 4=360°; 5=450°... |
| 36 | - | function turn(degree, dir) |
| 36 | + | -- keeps track of the robots current Angle. |
| 37 | - | local Degree = degree |
| 37 | + | function movement.turn(degree, dir) |
| 38 | - | local Direction = dir |
| 38 | + | local Degree = degree |
| 39 | - | for i=1, Degree do |
| 39 | + | local Direction = dir |
| 40 | - | if Direction==1 then |
| 40 | + | for i=1, Degree do |
| 41 | - | robot.turnLeft() |
| 41 | + | if Direction==1 then |
| 42 | - | if angle<4 then |
| 42 | + | robot.turnLeft() |
| 43 | - | angle=angle+1 |
| 43 | + | if angle<4 then |
| 44 | - | else |
| 44 | + | angle=angle+1 |
| 45 | - | angle=1 |
| 45 | + | else |
| 46 | - | end |
| 46 | + | angle=1 |
| 47 | - | end |
| 47 | + | end |
| 48 | - | if Direction==2 then |
| 48 | + | end |
| 49 | - | robot.turnRight() |
| 49 | + | if Direction==2 then |
| 50 | - | if angle>1 then |
| 50 | + | robot.turnRight() |
| 51 | - | angle=angle-1 |
| 51 | + | if angle>1 then |
| 52 | - | else |
| 52 | + | angle=angle-1 |
| 53 | - | angle=4 |
| 53 | + | else |
| 54 | - | end |
| 54 | + | angle=4 |
| 55 | - | end |
| 55 | + | end |
| 56 | - | end |
| 56 | + | end |
| 57 | - | print(angle) |
| 57 | + | end |
| 58 | - | end |
| 58 | + | print(angle) |
| 59 | - | |
| 59 | + | end |
| 60 | - | |
| 60 | + | |
| 61 | - | function returnHome(posX, posY, posZ, pointX, pointY, pointZ) |
| 61 | + | |
| 62 | - | local diffX = posX-pointX |
| 62 | + | function movement.returnHome(posX, posY, posZ, pointX, pointY, pointZ) |
| 63 | - | local diffY = posY-pointY |
| 63 | + | local diffX = posX-pointX |
| 64 | - | local diffZ = posZ-pointZ |
| 64 | + | local diffY = posY-pointY |
| 65 | - | |
| 65 | + | local diffZ = posZ-pointZ |
| 66 | - | gotoY(diffY) |
| 66 | + | |
| 67 | - | sleep(1) |
| 67 | + | gotoY(diffY) |
| 68 | - | turnToAngle(4) |
| 68 | + | sleep(1) |
| 69 | - | gotoXZ(diffZ) |
| 69 | + | turnToAngle(4) |
| 70 | - | sleep(1) |
| 70 | + | gotoXZ(diffZ) |
| 71 | - | turnToAngle(3) |
| 71 | + | sleep(1) |
| 72 | - | gotoXZ(diffX) |
| 72 | + | turnToAngle(3) |
| 73 | - | end |
| 73 | + | gotoXZ(diffX) |
| 74 | - | |
| 74 | + | end |
| 75 | - | -- Goes forward a given amount of @times. Warning! Does not set the Angle automatically! |
| 75 | + | |
| 76 | - | local function gotoXZ(times) |
| 76 | + | -- Goes forward a given amount of @times. Warning! Does not set the Angle automatically! |
| 77 | - | if times==0 then |
| 77 | + | local function gotoXZ(times) |
| 78 | - | return true |
| 78 | + | if times==0 then |
| 79 | - | elseif times>0 then |
| 79 | + | return true |
| 80 | - | tryForward(times) |
| 80 | + | elseif times>0 then |
| 81 | - | return true |
| 81 | + | movement.tryForward(times) |
| 82 | - | end |
| 82 | + | return true |
| 83 | - | end |
| 83 | + | end |
| 84 | - | |
| 84 | + | end |
| 85 | - | -- Goes up or down a set amount of @times, depending on if @times is pos. or neg. |
| 85 | + | |
| 86 | - | local function gotoY(times) |
| 86 | + | -- Goes up or down a set amount of @times, depending on if @times is pos. or neg. |
| 87 | - | if times==0 then |
| 87 | + | local function gotoY(times) |
| 88 | - | return true |
| 88 | + | if times==0 then |
| 89 | - | elseif times>0 then |
| 89 | + | return true |
| 90 | - | tryDown(times) |
| 90 | + | elseif times>0 then |
| 91 | - | return true |
| 91 | + | movement.tryDown(times) |
| 92 | - | elseif times<0 then |
| 92 | + | return true |
| 93 | - | local _times = (-1*times) |
| 93 | + | elseif times<0 then |
| 94 | - | tryUp(_times) |
| 94 | + | local _times = (-1*times) |
| 95 | - | return true |
| 95 | + | movement.tryUp(_times) |
| 96 | - | end |
| 96 | + | return true |
| 97 | - | end |
| 97 | + | end |
| 98 | - | |
| 98 | + | end |
| 99 | - | -- Turns form the current Angle towards @target Angle. |
| 99 | + | |
| 100 | - | local function turnToAngle(target) |
| 100 | + | -- Turns form the current Angle towards @target Angle. |
| 101 | - | if angle~=nil then |
| 101 | + | local function turnToAngle(target) |
| 102 | - | if angle~=target then |
| 102 | + | if angle~=nil then |
| 103 | - | if angle>target then |
| 103 | + | if angle~=target then |
| 104 | - | turn((angle-target), 2) |
| 104 | + | if angle>target then |
| 105 | - | return true |
| 105 | + | movement.turn((angle-target), 2) |
| 106 | - | end |
| 106 | + | return true |
| 107 | - | if angle<target then |
| 107 | + | end |
| 108 | - | turn((target-angle), 1) |
| 108 | + | if angle<target then |
| 109 | - | return true |
| 109 | + | movement.turn((target-angle), 1) |
| 110 | - | end |
| 110 | + | return true |
| 111 | - | else |
| 111 | + | end |
| 112 | - | return true |
| 112 | + | else |
| 113 | - | end |
| 113 | + | return true |
| 114 | - | else |
| 114 | + | end |
| 115 | - | return false |
| 115 | + | else |
| 116 | - | end |
| 116 | + | return false |
| 117 | - | end |
| 117 | + | end |
| 118 | - | |
| 118 | + | end |
| 119 | - | -- Forces to set the current Angle.(Not recommended!) |
| 119 | + | |
| 120 | - | function setAngle(_angle) |
| 120 | + | -- Forces to set the current Angle.(Not recommended!) |
| 121 | - | angle=_angle |
| 121 | + | function movement.setAngle(_angle) |
| 122 | - | end |
| 122 | + | angle=_angle |
| 123 | end | |
| 124 | ||
| 125 | return movement |