CNC Torch Table Z Height Control

Automatic capacitive sensing version of CNC Torch Table Height Controller

This is the automatic height levelling version based on the new TorchHeightCTRL_V.02 pcb. (All Sources on GitHub: [[1]])

Design rationale

The new pcb is an all-in-one board, that adds some peripheral interfaces to the application, like for endstop or a future direct user interface (Display).

In the automated version the 0mm-distance / start-position should be found automatically by homing. From this it will take a sample and then goes to 30mm height and take another sample for calibration. Then it will go into a loop and trying to balance the distance around a pre-set default-value of 15mm. But if you then push the button of the jogwheel you switch from autobalancing- into manual-mode and change this 15mm-default-value by turning the jogwheel. Pushing again switches back into autobalancing mode.

BOM

Quantity	Part	Supplier
1	Arduino Nano V3 with USB-cable	[2]
1	TB6600 stepper driver	[3]
1	KY-040 Rotary Encoder	[4]
1	Knob for rotary encoder (must be 3d-printed on your own !!!)	[5]
1	Power-Supply	[6]
1	Stepper Motor 17HS19-2004S, Nema17, with 2A and 59Ncm holding torque	[7]
1	Mechanical EndStop	[8]
1	Sensor-probe	to be selfmade, from a thick piece of copper wire and a BNC-cable (but a commercial version also exists)
1	5-pole DuPont connector breadbord-ribbon-cable, female2male, for the rotary encoder	[9]
1	1-pole DuPont connector breadbord-ribbon-cable, female2female, for elongate the SW-pin and connect it to the ICSP-port of the Arduino Nano.	[10]
1	4-pole DuPont connector breadbord-ribbon-cable, male2male, for the TB6600	[11]
1	D3D universal axis, as testrig or torch-mount	[12]
1	TorchHeightCTRL_V.02 pcb	can be ordered from Aisler as readymade project [13] (but you have to register there to see the project)
Set	Set of electronic parts for soldering on the pcb	can be ordered from Mouser as readymade projec01t24 and can be accessed at [14] (there you have to type in as project-key 64fff8ecbf) Wiring Schema Power Supply Warning: The phoenix-contact powersupply connector has NOT the same configuration than the connector of the same type on RAMPS-boards !!! Dont use the plug of a powersupply that was previously configured for use with a RAMPS-board and has 2 x 12V. The TorchHeightCTRL_V02 board has 1 x 5V and 1 x 12V and will be blown immedately if you give 12V to the 5V line !!! Wiring PowerSupply Connect 5V (red) and GND (black) from a PC-powersupply to the Phoenix Contact connector on the pcb as shown in the picture. Its a 4-pole connector, but leave two pins not connected (these are normally for 12V but its better to connect the TB6600 directly with the 12V) Use another string from the Powersupply and connect a 12V line directly with the TB6600, with 12V (yellow) to VCC and GND (black) to GND) TB6600 The TB6600 gets connected to J3 on the TorchHeightCTRL_V.02 pcb. Wiring TB6600 Connections from J3 to the TB6600: EN (blue) goes to ENA+(+5V), DIR (yellow) to DIR+(+5V), STEP (green) to PUL+(+5V) and one of the GNDs (orange; third pin from left to right on J3) to PUL-(PUL). It doesnt matter, which GND-pin you use, but make sure that on TB6600-side the remaining GND-pins are bridged/connected with the GND-pin that connects to J3. Here the pin ENA-(ENA) is bridged to DIR-(DIR) and then a second bridge goes from DIR-(DIR) to PUL-(PUL), which contains also the (orange) wire that connects to one GND on J3. The steppermotor pins on the TB6600 are labeled as B-, B+, A-, A+. I found, that at least for my motor the order must be B-, B+, A+, A-. Otherwise the motor is doing funny things. This may be different on other motors, but you can simply try it by exchanging A+ with A- or B+ with B -. See also the motor diagramm on [15]. The power lines should be connected directly with a 12V line of the powersuplly, as mentioned above. Rotary Encoder KY-040 The Rotary Eccoder pins GND, 5V, DT and CLK get connected with J7 on the pcb. If you turn the pcb that you can read the labl "J7 Jog" in the right orientation the pins on J7 are (from left to right): 5V, GND, DT, CLK. There is one more pin on the KY-040, labelled as "SW". This is a button-press-funktion. Unfortunately the pcb-design was initially intended for another type of rotary encoder, which had not this function, so its not incorporated in the original design. But there is however a workaround (without soldering) for now. The SW pin must be connected to one pin of the ICSP-port on top of the Arduino Nano. (Note: This pin is also part of the UEXT-port, which is not used now. But later we should replace it with another free pin, e.g. pin D9.) Wiring KY-040 J7, from left to right: 5V, GND, DT, CLK See the 6-pole ICSP-port on top of the Arduino Nano. The most right pin in the top row, denoted as "18, PB4, pcint4, MISO", has to be connected with the pin SW on the KY-040 EndStop The mechanical EndStop gets connected to J5 on the PCB. The Pinout of J5 is (from left to right): GND, DATA, 5V Capacitance-Sensor-Probe The SensorHead-Probe gets connected with a coaxial cable with BNC-connector, where the Sensing-Ring is connected to the inner wire. You can get an impression on how the probe is made from the video at [16]. For getting reasonable signal quality, its important to connect the metal-plate (your workpiece) and also the metal-parts of the test-rig with the SHIELD-ground from the sensor-probe. This is the internal shield-pin of the AD7747 and this is NOT (!!!) identical with the overall GND of the pcb. Therefore it is connected seperately. (Note: In a possible next generation/iteration of the pcb there should become definitely an extra screw-terminal connector with about 3 or 4 SHIELD-ground pins implemented.) Wiring Sensor-Probe SHIELD-ground can be obtained from the wire mesh shield or from the outer metal-parts of the BNC connector. Firmware Arduino-Code on Github:[[17]] Manual adjustable version of CNC Torch Table Height Controller This is a simple POC-version that allows a manual adjustment of the Z height by turning a jog wheel (see demonstration video on youtube: [18]). The wheel can be 3d-printed [19] and is connected to a rotary encoder of type KY-040. manually steered height control TB6600, Arduino_Mega/Ramps, KY-040 rotary encoder stepper driven lineardrive - demonstration video on youtube: [20] Design Rationale With this rig it should be possible to manually operate the torch table height by following its slowly moving and regulate the height personally. This can be useful even if in the full version there is a capacitive sensor doing automatically that task, but one may use it then for setting the starting height or use it in other applications where a frequent manual control is an appreciated option. The rotary encoder gives up to 20 pulses per revolution to an Arduino-Mega, which translates it into a number of motor steps and triggers these by a TB6600-based stepper-driver. A RAMPS 1.4 may act as a connection layer on top of the Arduino, but can also be omitted. We will show here which pins to wire on the Arduino and on the Ramps as well. The firmware consist only of a few lines of Arduino-code, which makes it easy to extend and modify. BOM Quantity Part Supplier 1 Arduino Mega 2560 [21] or under Linux the CHG340-version: [22] 1 Ramps 1.4 [23] 1 TB6600 stepper driver [24] 1 KY-040 Rotary Encoder [25] 1 Power-Supply [26] 1 Stepper Motor 17HS19-2004S, Nema17, with 2A and 59Ncm holding torque [27] 1 5-pole DuPont connector breadbord-ribbon-cable, male2male [28] 1 5-pole DuPont connector breadbord-ribbon-cable, female2female [29] Wiring There are 3 kind of connections: - Power-supply to Ramps/Arduino - Rotary Encoder to Ramps/Arduino - TB6600 to Ramps/Arduino Ramps-pins to connect are marked with a blue point Mapping of the Ramps-Pins onto the Arduino-Mega ports Power-supply to Ramps/Arduino 1. Ramps: Connect a 12V/5A-Line to the MSTBA4-Port an the Ramps, by using a phoenix-contact plug. This will provide power for Motor as well as board-power for the Arduino-Mega. 2. Arduino standalone: The Arduino musst be supplied with 5V to 12V. This can be done by the USB-connection to a desktop-pc or by a standard wall-wart ac/dc-adaptor (5V, 2A) for the Mega. RotaryEncoder to Ramps/Arduino The KY-040 RotaryEncoder has 5 Lines: GND, +5V, SW, DT, CLK. Connect these either to the AUX2 port of the Ramps, or directly to the corresponding digital I/O ports on the Arduino-Mega. GND --> GND 5V --> 5V SW --> D44 DT --> D42 CLK --> D40 KY-040 RotaryEncoder with 3d-printed jog-wheel The pins at the AUX2 port are conected to the rotary encoder TB6600 to Ramps/Arduino, Motor and Power The TB6600 stepepr driverhas three phoenix contact like connectors, - one 6-pin to the Ramps - one 4-pin to the motor - one 2 pin to power-supply The 6-pin connector has the lines ENA-, ENA+, DIR-, DIR+, PUL-, PUL+. Make a bridge between ENA- and DIR-, together with a second bridge from DIR- to PUL-. The PUL- contains a second cable which goes towards GND on the Ramps Extruder E0 port. So in total there are 4 wires going either to the Ramps or directly to the Arduino-Mega: 1. Ramps: ENA+ --> EN DIR+ --> DIR PUL+ --> STEP PUL- --> GND 2. Arduino-Mega: ENA+ --> D24 DIR+ --> D28 PUL+ --> D26 PUL- --> GND upper left corner: 2 white cables make a bridge between ENA-, PUL- DIR-. The PUL- contains an additional cable (orange) that connects to GND on the Extruder E0 port of the Ramps/Arduino The pins at the extruder E0 port are connected to the TB6600 The 4-pin connector has the lines A+, A-, B+, B-. In the case of a bipolar stepper motor with 4 wires two of them are the ends of one coil. Connect them like this: An example for a tested Nema17-stepper with 2A and 59Ncm holding torque is the 17HS19-2004S, see [30], [31]. The 2-pin connector has the lines 12V+, 12V-. Connect these to a power-supply which can deliver at least 5A. The TB6600 stepper driver is rated for up to 4A and 9-36V DC. That means you can instead of 12V also connect 24V or more towards it. Firmware Arduino-Code on Github: [32]